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ABSTRACT 


^Multivariable  control  theory  is  used  to  design  a  controller  for  a 
modified  drooping  stern  turning  submersible.  The  procedure  used  is 
based  on  the  LQG/LTR  methodology.  The  controller  is  designed  from  a 
linear  model  and  tested  for  performance  on  a  nonlinear  system  model. 
Control  variables  are:  turning  velocity,  roll,  and  pitch.  The  resulting 
controller  successfully  minimizes  roll  and  pitch  for  a  turning  submer¬ 
sible. 
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CHAPTER  I 


INTRODUCTION 


1 .  I  Introduction 

In  the  present  age  of  high  technology  and  sophisticated  develop¬ 
ment  of  vehicles,  both  air  and  submersible,  designers  continue  to  push 
the  performance  limits  of  their  designs,  due  to  increased  demands  on 
system  requirements.  Aircraft  are  required  to  perform  faster,  at  higher 
and  lower  altitudes.  Submersibles ,  especially  submarines,  are  being 
designed  to  dive  deeper  and  faster.  It  is  this  last  category  of  ve¬ 
hicles  that  this  thesis  addresses. 

The  operating  envelope  of  a  submarine  is  predicated  on  its  design 
depth  and  speed  plus  its  ability  to  handle  a  mechanical  casualty  with 
enough  time  to  recover  before  exceeding  test  depth  of  the  hull.  Cur¬ 
rently,  submarines  have  the  capability  to  operate  at  depths  greater  than 
700  feet  and  speeds  in  excess  of  30  knots. 

The  current  hull  design  has  been  determined  to  be  the  most  effi¬ 
cient  hydrodynamic  design  and  has  evolved  from  the  Albacore.  Addition¬ 
ally,  the  rudder  and  sternplane  cnfiguration  has  basically  been  un¬ 
changed  from  the  cruciform  design  for  decades.  The  cruciform  stern  is 
quite  a  sensible  design  in  case  of  a  casualty  situation.  When  one  wants 
to  climb  or  dive,  all  one  has  to  do  is  either  command  rise  or  dive  on 
the  sternplanes.  To  turn,  a  similar  situation  exists.  One  just  needs 
to  turn  the  rudder  in  the  desired  direction  one  wants  to  go  which  also 
causes  the  boat  to  dive.  However,  the  cruciform  stern  arrangement  has 
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its  drawbacks.  There  is  no  differential  control,  i.e.,  both  the  upper 
and  lower  rudders  are  mechanically  tied  together  as  are  the  right  and 
left  sternplane  control  surfaces.  A  severe  casualty  such  as  a  stern- 
plane  jam  on  dive  does  not  allow  for  independent  action  on  the  stern- 
plane  control  surface.  The  corrective  action  to  combat  this  casualty  is 
to  quickly  reverse  propulsion  power  direction  and  command  full  rise  on 
the  sailplanes.  All  of  this  corrective  action  must  be  accomplished  fast 
enough,  before  the  boat  exceeds  test  depth.  Finally,  the  cruciform 
stern  does  not  effectively  allow  the  boat  to  maintain  a  level  attitude 
in  a  turn.  The  boat  has  a  natural  tendency  to  roll  thereby  causing  the 
rudder  to  contribute  to  pitch  as  if  it  were  a  stern  surface. 

In  order  to  effectively  correct  the  drawbacks  of  the  cruciform 
stern,  an  alternative  stern  configuration  could  be  used  employing  dif¬ 
ferential  control  of  its  surfaces,  i.e.,  each  surface  independently 
operated.  The  independent  action  would  allow  the  operator  to  deflect 
the  control  surfaces  that  effect  depth  in  a  casualty.  Also,  if  a  stem- 
plane  jam  casualty  occurred,  then  the  plane  that  did  not  suffer  the 
casualty  could  be  used  to  control  the  rate  of  depth  excursion,  while  the 
propulsion  plant  is  used  to  slow  the  vehicle.  Differential  action  of 
the  stern  control  surfaces  can  also  be  used  to  counteract  the  forces 
that  cause  roll,  thereby  prohibiting  undesirable  depth  changes  of  the 
vehicle . 

The  stern  configuration  that  will  be  considered  in  this  thesis  is 
called  a  modified  drooping  stern  (MDS) .  The  MDS  consists  of  a  single 
rudder  surface  with  two  dihedral  surfaces  37.5°  below  the  horizontal. 

In  theory  the  MDS  should  be  able  to  effectively  control  roll  and  enable 
the  operator  to  combat  a  sternplane  casualty.  However,  the  MDS  presents 
the  operator  with  a  coordination  problem  in  that  its  movement  is  not  so 
straightforward;  for  example,  for  normal  cruising,  how  should  one  de¬ 
flect  the  dihedral  surfaces  to  control  the  effects  of  roll?  It  there¬ 
fore  becomes  of  considerable  importance  to  design  an  automatic  control 
system  that  handles  such  a  vehicle  in  operation. 
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In  this  thesis  a  truly  multivariable  automatic  controller  will  be 
designed  for  the  MDS  configuration.  Since  there  exists  a  number  of 
operating  points  within  the  submerged  envelope,  we  have  selected  as  a 
nominal  design  point  that  which  describes  the  situation  of  a  two  degree 
deflection  of  the  rudder  and  small  deflections  of  the  dihedrals,  while 
the  boat  is  at  a  velocity  of  21  knots. 

A  sketch  of  the  proposed  submersible  is  located  in  Figure  1.  The 
overall  length  is  180  feet  with  a  top  speed  of  21  knots.  Mass  proper¬ 
ties  are  summarized  in  Appendix  A.  The  convention  for  positive  deflec¬ 
tions  of  the  control  surfaces  are  shown  in  Figure  2,  using  the  right 
hand  rule  system.  The  rudder  and  dihedral  surfaces  will  be  referred  to 
as  Dl,  D2 ,  and  D3  and  will  be  limited  to  a  maximum  deflection  of  plus  or 
minus  forty  degrees. 

The  mathematical  model  used  for  the  control  design  utilizes  the 
six  degree-of-f reedom  nonlinear  differential  equations  as  developed  by 
Gertler  and  Hagen  known  as  the  NSRDC  Model  2510  [1].  The  linear  hydro- 
dynamic  coefficients  employed  in  the  2510  equations  are  derived  in  Chap¬ 
ter  2.  All  nonlinear  coefficients  used  are  based  on  submersibles  of 
similar  size  and  shape.  Since  this  submersible  has  never  been  con¬ 
structed  on  scale  basis  or  tested  in  a  tow  tank,  the  accuracy  of  the 
coefficients  could  not  be  verified.  However,  the  computer  model  behaved 
in  a  reasonable  manner  as  one  would  expect  with  a  full  scale  equivalent 
model. 

The  origin  of  the  submarine  fixed  axes  is  located  at  the  center 
of  gravity.  The  positive  directions  of  axes  are:  x-direction,  forward; 
y-direction  to  starboard;  z-direction  downward.  The  linear  and  angular 
velocity  components,  forces  and  moments  are  shown  in  Figure  2  [6]. 

This  thesis  will  develop  and  design  a  multivariable  automatic 
controller  for  the  submarine  model  in  Chapter  2.  Chapter  2  consists  of 
the  development  of  the  linear  hydrodynamic  coefficients  and  explains  the 
modifications  made  to  the  six  degree-of-freedcm  equations  of  motion. 
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Additionally,  an  explanation  is  provided  as  to  how  the  equations  of 
motion  were  linearized.  Chapter  3  consists  .  the  controller  (compen¬ 
sator)  design.  It  includes  a  brief  explanation  of  the  control  varia¬ 
bles,  system  augmentation,  and  calculation  of  the  control  gain  matrix, 

(3,  and  the  filter  gain  matrix,  H,  which  result  from  the  frequency  domain 
loop  shaping  methodology  employed  for  the  design.  The  design  method¬ 
ology  itself  is  also  discussed  briefly.  Chapter  4  summarizes  the  re¬ 
sults  of  the  nonlinear  controller  simulations.  Finally,  Chapter  5  lists 
the  conclusions  and  recommendations  as  drawn  from  the  resultant  sub¬ 
marine  model  and  controller  design. 

1 . 2  Contributions  of  Thesis 

The  contributions  of  this  thesis  is  twofold:  (i)  evaluation  of 
the  MDS  configuration  for  a  submersible  in  a  high  speed  turn, 

(ii)  design  of  an  automatic  control  system  to  facilitate  the  MDS  opera¬ 
tion  using  Linear  Quadratic  Gaussian/Loop  Transfer  Recovery  (LQG/LTR) 
methods . 

The  emphasis  is  on  the  frequency-domain  properties  of  the  state- 
space  based  LQG  designs.  Simple  and  efficient  tools  for  loop  shaping 
are  employed  that  lead  to  satisfactory  designs.  These  tools  accomplish 
singular  value  "pinching”  in  the  high  and  low  frequency  ranges,  so  as  to 
satisfy  stability  and  performance  requirements. 

Moreover,  this  thesis  tests  the  controller  designed  on  the  basis 
of  a  linear  r 'del  on  the  nonlinear  process  model  which  is  a  better 
approximation  to  the  actual  system. 
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CHAPTER  2 


THE  SUBMARINE  MODEL 


2 . 1  Nonlinear  Equations  of  Motion 

The  equations  of  motion  describing  the  design  vehicle  in  this 
thesis  as  already  mentioned,  were  the  six  degree-of- freedom  equations 
contained  in  the  NSRDC  document  2510  [1].  The  coefficients  of  the  equa¬ 
tions,  as  developed  in  Section  2.3,  describe  the  vehicle's  geometry. 
Modification  was  made  to  the  equations  to  account  for  the  geometry  of 
the  MDS  configuration.  The  terms  that  involved  both  rudder  and  stern- 
plane  action  were  combined;  these  can  be  seen  in  the  lateral  force, 
pitching  moment  and  yawing  moment  equations.  The  factors  that  premul¬ 
tiply  the  corresponding  surface  deflections  were  based  upon  the  geometry 
depicted  in  Figure  3. 

D1  is  primarily  used  for  rudder  control  while  control  surfaces  D2 
and  D3  are  used  for  depth  and  roll  control.  However,  D2  and  D3  can  also 
act  as  an  additional  rudder  and  their  potential  contribution  can  be  seen 
from  the  lateral  force  equation  where  the  multiplying  coefficient  is 
given  by  sin  37.5°  =  0.6088.  The  resulting  term  looks  like  the  follow¬ 
ing,  Dl  -  0.6088D2  +  0.6088D3.  Additionally,  this  term  takes  into  ac¬ 
count  the  sign  of  the  hydrodynamic  coefficients  Y.  and  Y .  ^ .  In  this 
case  both  and  Y . ^  are  positive  and  employ  the  sign  convention  as 
established  in  Figure  2.  Likewise,  the  stern  contribution  terms  in  the 
pitching  and  yawing  moment  equations  have  similar  form. 


For  depth  control,  surfaces  D2  and  D3  are  used.  The  factor 
cos  37.5°  =  0.7934  appears.  Depending  on  the  sign  of  the  hydrodynamic 

coefficients  Z . ,  Z.  ,  M, ,  M„  ,  N.,  and  N.  ,  the  sign  of  the  deflecting 

o  or,  6  on  i  o " 

term  is  assigned. 

One  must  keep  in  mind  that,  not  all  hydrodynamic  coefficients 
involving  a  control  surface  have  a  value  that  can  be  predicted  or  meas¬ 
ured  in  model  tests.  If  a  value  could  be  determined,  then  one  would 
assign  the  additive  or  subtractive  nature  to  the  contribution  of  the 
control  surface  based  upon  the  sign  of  the  corresponding  hydrodynamic 
coefficient.  The  resulting  nonlinear  and  auxiliary  force  equations  are 
given  in  Appendix  B. 

2 . 2  Linearized  Equations  of  Motion 

Control  design  requires  that  the  nonlinear  equations  of  motion  be 
linearized  about  a  nominal  operating  point.  The  nonlinear  equations  are 
of  the  form 


Ex  =  f (x,  u)  (2.1) 

from  which  one  can  derive  the  linearized  equations  in  the  form 

E2 x  =  A2 x  +  BAu  (2.2) 

which  represents  a  Taylor  Series  expansion  of  the  nonlinear  equations 
about  a  nominal  point  x^  and  Ug ,  by  retaining  only  the  first  order 
terms.  More  specifically,  expanding  Equation  (2.1)  in  a  first  order 
Taylor  Series  around  a  nominal  point,  one  gets 

Ex^_  +  EAx 

(2.3) 


=  f  (x  , 

—  — o 


V  + 


31(V 


V 


3x 


<*-5o> 


3  f  (x  , 
- o 


Ho) 


(H  -  Hq) 
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If  one  lets  -lx  =  (x  -  x  )  and  ‘.u  =  (u  -  u  )  where  x  is  the  nominal 

—  —  — o  —  —  — o  — o 

state  vector  and  u  the  nominal  input  which,  furthermore,  are  known  to 
— o 

satisfy  the  original  nonlinear  equations,  then  one  is  left  with 


E-\x  = 


H(x  , 

—  — o 


ix  + 


’f  (x  , 
- o 


Ho) 


Au 


(2.4) 


3f(x  ,  u  )  lf(x  ,  u  ) 

,  -  —  — o  — o  .  _  —  — o  — o 

where  A  =  - ; - and  B  =  - ; - 

—  —  .;MJ 

listed  in  Appendix  C. 


The  linearized  equations  are 


Additionally,  the  full  nonlinear  equations  include  crossflow  and 
vortex  shedding  terras.  For  the  purpose  of  this  thesis,  the  crossflow 
term  was  linearized  while  the  vortex  shedding  term  was  omitted.  The 
reason  for  this  was  to  be  able  to  compare  the  results  of  this  submer¬ 
sible  to  a  full  scale  model,  whose  linearized  equations  did  not  include 
vortex  shedding,  either. 


2 . 3  Hydrodynamic  Coefficients 

The  hydrodynamic  coefficients  that  comprise  the  linear  and  non¬ 
linear  equations  of  motion  are  very  important  in  the  mathematical  model. 
The  linear  coefficients  can  be  estimated  using  equations  based  on  the 
geometry  of  the  submersible.  The  nonlinear  coefficients  are  normally 
the  result  of  model  tests  either  in  a  tow  tank  or  wind  tunnel.  The 
coefficients  not  calculated  in  this  thesis  are  taken  from  past  designs 
of  similar  size  and  shape  vehicles. 

2.3.1  Body  Coefficients  [2] 

We  assume  a  prolate  ellipsoid  for  the  hull  shape,  where  the  major 
and  minor  axes  are  given  by 
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a  =  90  ft  b  =  10  ft 

„  4  ,2 

V  =  —  ?rab 

V  =  37,699  ft3 

The  buoyant  force  of  the  ellipsoid  is 

B  =  pV 

B  =  2.4283  x  106  lbf. 

The  surface  area  of  the  ellipsoid  is  given  by 

S  =  2:rb3  +  2 rr  sin  ^  e 

e 


From  Lamb  [3]  with  ^  =  9,  the  factors 
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K'  =  0.8645 

K  =  0.0241 


K2  =  0.9538 


can  be  obtained.  The  moments  of  inertia  for  the  body  are  as  follows 


I  =  I  for  a  prolate  ellipsoid 
yyzz  r 


m  = 


B 


2.4283  x  io°  lbf 


32.17 


ft 


32.17 


ft 


=  75483  slugs 


2  2 

m(a  +  b  ) 


yy 


1.2379  x  io8  slugs-ft2 


I  =  1.2379  x  io8  slugs-ft2 

zz 


m(2b2) 


XX 


I  =  3.0193  x  io6  slugs-ft2 

XX 


The  mass  and  moments  of  inertia  can  be  nondimensionalized  bv 
dividing  with  the  appropriate  factor. 
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I* 

m ' 

Therefore, 

I' 

yy 

i' 

XX 

m' 

The  center  of  gravity  is 
starboard  plane  of  symmetry,  12 

X, 

Y( 

Z 


(i) 


m 


I’  =  0.000654 

zz 

0.000016 

0.1293 

assumed  to  be  located  in  the  port- 
inches  below  the  centerline. 

=  0 

,  =  0 

,  =  1  ft 


Nondiraensionalizing , 


Z'  =  — p  =  0.00556 

U  c 

From  Newman  [4],  the  Reynolds  number  for  a  body  in  10°C  seawater  at 
2L  KTS,  is  given  by 
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(21) (1.689) (180) 
1.35  x  10-6  (3 . 281) 2 


=  4.3931  x  108 


Assuming  that  the  frictional  drag  coefficient  is  equal  to  the  drag  coef¬ 
ficient  and  using  the  ITTC  frictional  resistance  line  gives 


CD  "  CF 


0.075 


d°sL0  R  " 


C  =  C_,  =  0.0017 

D  F 


for  the  coefficient  of  drag. 

The  body  hydrodynamic  coefficients  can  now  be  calculated  ( 5 J . 


Y^  =  -0 . 234 (m' ) ° ‘ 79  -  ~  =  -0.008009  (2.5) 


Y' 

r 

=  -(0.10  -  K^m'  =  0 . 00098 1 

(2.6) 

Z' 

=  Y'  =  -0.008009 

(2.7) 

w 

V 

Z’ 

=  -Y'  =  0.000981 

(2.8) 

q 

r 

M' 

w 

=  0 . 87  (Kn  -  K^m'  =  0.010458 

(2.9) 

M' 

n 

=  0 . 045 (m' )  =  0.000582 

(2.10) 

q 
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-0.010458 


(2.11) 


N '  =  -M’  = 

v  w 


N' 


r 


X-  ' 

u 


Y  •  ' 
v 


M'  =  -0.000582 

a 

-K^m'  =  -0.000312 

-K?m'  =  -0.012333 


Y  •  'Z 

Y  *  '  =  — — S-  =  -0.000069 

P 


K-’  =  Y-'  =  -0.000069 

v  p 


!•'  =  Y • '  =  -0.012333 

w  v 


M-'  =  -K'l'  =  -0.000565 

q  y 


N • '  =  M-'  =  -0.000565 

r  q 


2.3.2  Fin  Coefficients  [6] 

The  MDS  stern  configuration  introduces  asymmetry  about  the 
terline  of  the  vertical  plane.  Several  views  have  been  depicted 
allow  calculation  of  areas,  aspect  ratios  and  planes  of  motion, 
ures  3  and  4  depict  fin  dimensions. 

For  a  single  fin: 


=  Projected  area 
=  100.4  ft2 


(2.12) 

(2.13) 

(2.14) 

(2.15) 

(2.16) 

(2.17) 

(2.18) 

(2.19) 

cen¬ 

to 

Fig- 
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4.5  ft 


Figure  3.  Rear  view 


rudder,  and  dihedral  fin  dimensions 


8.9  ft  {  I  6.4  ft  I  I  I  10.4  ft 


\ 


PROJECTED  AREA  =  186.4  ft2 

PROJECTED  AREA  OF 
MOVEABLE  PORTION  =  68.9  ft2 


HORIZONTAL 


gure  4. 


Vertical  and 


horizontal  plane  projections. 
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A  =  Projected  area  of  movable  portion 
m  J 

=  80.6  ft2 

s 

ARj;  =  aspect  ratio  of  fin  =  — 

c 

s  =  28  ft  c  =  8.25  ft 

ARf  =  3.394 

AR^  =  aspect  ratio  of  the  movable  portion 

=  6.222 

For  the  horizontal  plane  projection  contributions,  one  has: 

A^p  =  projected  area  of  the  horizontal  plane 
=  186.4  ft2 

aspect  ratio  in  the  horizontal  plane 
=  2.69 

The  following  definitions  are  used  in  calculating  A  and 


In  the  vertical  plane 

AR  =  3.394 

A  =  100.4  ft2 

CT  =  3.953 

La 
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distance  from  center  of  buoyancy  to  center  of  pressure 
of  the  stern 


The  center  of  pressure  is  assumed  to  be  1/2  the  mean  chord  length 
forward  of  the  hailing  edge.  For  this  vehicle 


x  =  -94.5  ft 

cp 


= 

v 


-cLa(V 


-0,012249 


(2.20) 


N'  = 
v 


Y'X 
v  CP 


=  0.006431 


(2.21) 


The  contribution  to  roll  due  to  asymmetry  is 


where  Z  was  calculated  bv  summing  the  different  components  of  the 
cp  ' 

vertical  projection  times  their  moment  arm  and  then  divided  by  the  total 


For  this  vehicle  a  value  for  Z  was  found  as 

cp 


Z  =  10.9  ft 

cp 


Therefore 


-0.000742 


(2.22) 


For  the  horizontal  plane  projection 

a  =  2.64 

A  =  186.4  ft2 

C7  =  3.604 

La 


whereby 

— C  A 

Z'  =  — ^2—  =  -0.020733 

w  .  2 

M’ 

-Z'x 

W  Cp 

=  -0.010885 

w 

Z' 

=  M’  = 

-0.008673 

q 

w 

Y' 

=  N '  = 

0.006276 

r 

V 

K' 

-K’x 

v  cp 

=  -0.000380 

r 

M' 

-Z'x 

q  cp 

=  -0.004553 

q 

i 

N' 

Y '  x 

=  _£_££. 

=  -0.003295 

r 

i 

(2.23) 

(2.24) 

(2.25) 

(2.26) 

(2.27) 

(2.28) 

(2.29) 


In  order  to  calculate  K',  the  method  will  be  applied  to  an  indiv¬ 
idual  fin. 
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f 


A  =  100.4  ft2 

CT  =  3.953 

La 


-C  A 

Y"  =  — =£-  =  -0.012249 

v  ,2 


then 


K'  = 
P 


Z'  is  the  distance  from  centerline  to  center  of  pressure  of  the 
cp  r 

individual  fin.  For  this  fin  Z'  =  7.44  ft 

cp 


K'  =  -0.000021 

P 


The  for  the  design  vehicle  will  be  three  times  the  above  value. 


K'  =  -0.000063  (2.30) 

P 


Abkowitz  [7]  provides  a  means  for  calculating  the  acceleration 
derivatives.  In  the  horizontal  plane 


Z- 

w 


TTpS 


2  2 
c 


4Vs“  +  c" 


where  s  is  the  span  and  c  is  the  chord. 


s  =  11.1  ft  +  11.1  ft  =  22.2  ft  c  =  8.25  ft 
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0.000331 


(2.31) 


Z-  ' 
w 


In  the  vertical  plane, 


Y- ' 
v 


where 


s  =  14  ft  +  8.5  ft  =  22.5  ft 


c  *  8.25  ft 


Hence , 


Y-  ' 

v 


M*  ’ 
w 


N* ' 


v 


Z-  ' 

q 


M*  ' 

q 


N  •  * 
r 


-0.000336 

Z-  'x 

— -Cp-  =  -0.000174 

-Y-  'x 

— =  -0.000176 

-M-'  =  0.000174 


w 


-0.000091 


-0.000093 


Y*  'z 
v  cp 


(2.32) 

(2.33) 

(2.34) 

(2.35) 

(2.36) 

(2.37) 


-0.000020 


(2.38) 


0.000176 


(2. 39) 


Y • '  =  N* '  = 

r  v 

Contributions  due  to  the  deflections  of  the  fins  result  in  the 
following  coefficients,  for  which  it  suffices  to  calculate  those  for  one 
fin  only. 


Y  i  _  ClA 

5  ?2 

a  =  ^  =  3.394 

CT  =  3.95 

La 

^  =  46.8  ft2 

Y  ^  =  0.005706 


Z 


-0.007656 


(2.40) 


where  CT 
La 


=  3.6  and  =  68.9  ft 


2 


Y' jz"  1 

K'  =  —  ,CE--  =  0.000269 

o  ?, 


(2.41) 


where  Z’ '  is  the  distance  for  the  moveable  portion,  -8.46  ft. 


-Z'.x 

M!  =  — =  -004019 

5  J. 


(2.42) 
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X 


N 


5 


CLctAM 

.2 


l 


where 


=  28.8  ft" 


Nr  =  -0.001680 

6 


(2.43) 


When  the  fins  are  deflected,  drag  forces  are  induced.  The  drag 
force  of  a  body  is  given  by 


x 


2  CDpAu 


2 


From  Comstock  [8], 


C 


D 


JD0 


+ 


ae 


where 


a  =  AR^  =  1.182 
e  =  0.9  (Oswald  efficiency  factor) 


Since 


C 


L 


1.656 


then 


C 


D 


CDQ  +  0 . 8 1 4  6  6  2 
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Substituting  this  into  the  X  equation 


(cD0  +  0.8146  2)pV2 

X  _  2 

and,  taking  the  second  derivative  with  respect  to  5^,  one  gets 


X 


55 


0 . 8146pA^u 


2 


Next,  nondimensionalizing. 


X 


55 


-0.004053 


(2.44) 


2.3.3  Sail  Coefficients 

Figure  5  shows  the  dimensions  of  sail  used.  Using  the  method 

described  in  Reference  8,  to  evaluate  C,  for  the  sail  one  calculates 

La 

the  following. 


0  radian  for  sail 


AR  =  a  -  _  K25 

s  16 


A  =  160  ft 


2t 


'La 


=  2.42 


1  + 


AR 


31 


-0.011934 


(2.45) 


Y' 

v 


A 


The  center  of  pressure  is  assumed  to  be  located  at  the  1/4  chord  length 
from  the  forward  edge. 


x  =  28  ft 

cp 


-Y'x 

Nv  =  — =  °-001856  (2.46) 


The  contribution  to  roll  is 


K' 

v 


Y'z 
v  cp 

2 


where  z  is  the  distance  from  the  centerline  of  the  vehicle  to  the 
cp 

vertical  center  of  pressure,  and  z  =  z'  -15  ft  for  this  submersible. 

cp  cp 

Then , 


K’  =  0.000155  (2.47) 

v 


Y'  =  N'  =  0.001856  (2.48) 

r  v 


Y'x 

N’  =  C- -Cp  =  0.000289  (2.49) 

r  2 


Kp  =  Yv  (~F)  =  -°-000083  (2.50) 
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I 


The  acceleration  derivatives,  according  to  Abkowitz  can  be  de¬ 
rived  analogously  as  for  the  stern  control  surfaces.  In  this  case,  the 
span  will  be  twice  the  height  of  the  sail  and  the  resulting  derivative 
will  be  divided  in  half  and  then  nondimensionalized .  In  the  vertical 
plane  one  gets 


Y  • 1 

v 


Y*’  =  -0.000886 

v 


where 


s  =  20  ft 

c  =  16  ft 


Hence 


-Y  •  '  x 

N  •  '  =  — —n -  -SE  =  0.000138 


Y*  '  z 

K* '  =  £2- 


0.0000 74 


N  •  '  =  Y-  ' 

r  v 


x  \2 


(¥) 


-0.000021 


Y-'  =  N-’  =  -0.000138 

r  v 


K* '  =  Y-' 

P  v 


z  \2 


-0.000006 
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(2.51) 


(2.52) 

(2.53) 

(2.54) 

(2.55) 

(2.56) 


1 


2.3.4  Sailplane  Coefficients 

Figure  6  shows  the  geometry  of  the  sailplane.  The  center  of 
pressure  is  assumed  to  be  1/2  mean  chord  length  forward  of  the  trailing 
edge.  For  this  vehicle. 


x 

cp 


24  ft 


The  following  definitions  are  used  in  calculating  A  and  C^. 


b  =  tip  of  fin  to  hull  centerline 

=  11  ft 

d  =  maximum  diameter  of  hull 

=  20  ft 

a  =  aspect  ratio  =  2.67  for  a  single  plane 

A  =  31.5  ft2 

CLa  =  3'59 

“CLaA 

Z'  =  — =  -0.003490  (2.57) 

w  ,  2 

-Z  1  x 

M'  =  — =  0.000465  (2.58) 

w  i 

There  is  no  contribution  to  roll  in  the  horizontal  plane. 
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K2ft-H 


SCALE:  1/4  in.  =  1  ft 


PROJECTED  AREA  OF 
SINGLE  FIN  =  31.5  ft2 


Figure  6.  Sailplane  geometry. 
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z' 

q 


0.000465 


(2.59) 


-Z'x 
w  cp 


Z'x 

M'  =  -3-1C-£  =  0.000097  (2.60) 

q  i 


The  contributions  due  to  the  deflection  of  the  fins  are  calcu¬ 
lated  in  a  similar  fashion  as  before. 


C  A 

z;b  =  =  -0.005429 


where  z"  for  the  sailplane  is  16  ft. 
cp 


(2.61) 


M' 

0 


l 


0.000724 


(2.62) 


As  with  the  stern  control  surfaces,  when  the  fins  are  deflected, 
drag  forces  are  induced. 


a  =  AR  =  -  =  1.2727 

msp  — 
c 

e  =  0.9  (Oswald  efficiency  factor) 


Since 


C 


L 


3.205 
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then 


r  =  r  + - 

D  DO  *rae 


=  CDQ  +  0.450162 


Substituting  this  into  the  expression  for  the  drag  force  of  a 
12 

body  x  =  y  C  pAu  gives 


x 


fcL.  +  0.4501;2)oA  u" 
(  DO _  /  msp 


Taking  the  second  derivative  with  respect  to  5 , 


X,.  =  0 . 4  50 1 c  A  u 

3  0  msp 


Non  d imen  s iona 1 i z in  g , 


-0.001750 


(2-63) 


The  acceleration  derivatives  for  the  sailplanes  are  calculated  as 
follows,  with  c  =  5.25  ft  and  s  =  14  ft.  In  the  horizontal  plane. 


Z*  ' 


w 


( 14)  2  (5  ■  5)  2 
4n/(  14) 2  +  ( 5 . 5)  2 
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0.000092 


(2.64) 


M-  '  = 

w 


Z*  X 
W  Cl 


=  0.00001- 


(2.65) 


M-’  =  0.000012 

w 


(2.66) 


V  i¥)' 


-0.000002 


(2.67) 


The  hydrodynamic  data  to  be  utilized  by  the  SUBRUN  computer  program, 
that  will  generate  the  linear  dynamics,  requires  that  the  coefficients 
be  input  in  a  dimensionalized  form  rather  than  a  nondimensionalized 
form.  Appendix  D  contains  a  listing  of  dimensionalized  hydrodynamic 
data  and  dimensionalizing  factors  for  this  purpose. 

2 . 4  Computer  Program  Description 

The  computer  program,  SUBMODEL,  used  for  this  thesis  was  devel¬ 
oped  at  Draper  Laboratory  [9].  The  program  has  the  capability  to  inte¬ 
grate  the  nonlinear  equations  of  motion  of  a  submarine;  search  for  a 
local  equilibrium  point  in  the  nonlinear  equations  of  motion;  calculate 
the  linearized  dynamics  of  the  linearized  equations  about  a  nominal 
point;  integrate  the  linearized  equations  of  motion;  simulate  the  com¬ 
pensated  vehicle  using  either  the  nonlinear  or  linear  equations. 

As  previously  stated,  the  nonlinear  equations  take  the  form  of 
Equation  (2.1) 


f  (x,  u) 
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where 

x  =  10  •  1  state  vector  with  states  u,  v,  w,  p,  q,  r,  phi, 

theta,  psi  and  z,  the  last  four  describing  the  vehicle 
attitude  with  respect  to  an  inertial  reference  frame. 

u  =  4  x  l  control  vector  with  DB,  Dl,  D2 ,  D3  as  members 

f  =  10  •<  1  vector  that  is  a  nonlinear  function  of  the  states 
and  the  controls 

E  =  10  x  10  matrix 

The  nonlinear  equations  were  integrated  with  the  RPS  propulsion 
model,  as  described  in  Appendix  E,  using  as  input  a  velocity  in  teet/ 
second  (corresponding  to  21  knots)  with  initial  values  of  zero  for  all 
states,  with  the  exception  of  Dl  deflected  to  2  decrees,  D2  deflected  to 
0.5  degree  and  D3  deflected  to  -0.4744  degrees.  The  assumption  is  made 
in  the  propulsion  data  that  wake  and  thrust  deduction  : actors  vary 
slightly  and  are  therefore  considered  constant.  The  nominal  point  is 
then  determined  by  integrating  the  nonlinear  equations  with  the  eta 
propulsion  model  using  as  inputs  for  the  states,  the  final  value  of  the 
states  from  the  RPS  integration. 

Once  the  nominal  point  has  been  determined,  the  linearized  dynam¬ 
ics  can  be  calculated  by  linearizing  about  that  nominal  point  (see  Ap¬ 
pendix  E  for  a  description  of  Nominal  Point).  Recall  that  the  linear¬ 
ized  equations  are  of  the  form 

EAx  =  A'Ax  +  B''.u  (2.68) 

or,  equivalently,  the  conventional  representation  form 

x  =  E  ^A’x  +  E  ^B'u  =  Ax  4-  Bu  (2.69) 
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On  can  easily  see  that  A  in  state  space  form  equates  to  E  A'  and  B 
equates  to  ^JB' .  It  is  _E  ^A'  and  _E  that  define  the  linear  system 
dynamics,  on  which  the  control  design  is  based. 

To  validate  the  resulting  linear  model,  one  perturbs  the  states 
of  the  nominal  point  and  compares  the  resulting  responses  of  the  per¬ 
turbed  linear  and  nonlinear  models.  Perturbation  from  the  nominal  point 
on  the  order  of  10%  is  adequate  for  checking  validity  of  the  linear 
model  behavior  in  comparison  to  the  nonlinear  model.  Figure  7  shows  the 
graphical  responses  of  the  two  models  for  comparison. 

Once  the  controller  has  been  designed,  the  effectiveness  of  its 
operation  can  be  tested  by  using  it  on  the  previously  derived  linear  and 
nonlinear  models  and  analyzing  their  responses  to  step  and  ramp  inputs. 

A  description  of  the  controller  development  is  given  in  Chapter  3  with 
the  results  of  the  subsequent  testing  in  Chapter  4. 
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NON-LINEAR  RESPONSE 


NON-LINEAR  RESPONSE  (CONT’DI 


time; 
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Figure  7.  (Cont.) 
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CHAPTER  3 


COMPENSATOR  DESIGN 


3.L  Overview  of  the  LQG/LTR  Procedure  [10] 

In  this  chapter,  a  controller  will  be  designed  using  the  LQG/LTR 
design  procedure.  The  singular  value  loop  shaping  approach  will  be  used 
to  mold  the  singular  values  of  the  system  open-loop  transfer  function  to 
meet  the  specifications  of  performance  and  robustness  to  plant  uncer¬ 
tainty  and  modeling  errors.  In  order  to  meet  the  performance  specifi¬ 
cations  of  small  steady  state  errors,  one  desires  high  DC  gains.  To 
minimize  the  effect  of  wave  encounter  and  modeling  errors  at  high  fre¬ 
quencies,  we  desire  crossover  at  about  0.1  radians  per  second  with  a 
large  roll-off  after  crossover.  This  will  ensure  attenuation  of  high 
frequency  modeling  errors  and  sensor  noise,  as  well  as  wave  effects 
which  typically  occur  in  the  0.2  to  2  radian  range. 

The  LQG  procedure  is  a  mathematical  method  of  designing  a  robust 
multivariable  controller  for  a  state  space  system.  The  designer,  how¬ 
ever,  has  the  flexibility  to  pick  the  parameters  of  the  design  motivated 
from  a  frequency  domain  setting.  An  iterative  design  process  is  then 
carried  out,  during  which  the  designer  is  able  to  match  desired  fre¬ 
quency  domain  characteristics,  captured  by  the  singular  values  of  the 
multivariable  system,  which  are  equivalent  to  the  SISO  Bode  plots,  by 
using  time-domain  mathematics  as  derived  for  the  solution  of  the  origi¬ 
nal  optimal  control  problem.  In  this  way,  a  systematic  procedure  can  be 
carried  out,  with  the  mathematical  solution  kept  simple  and  in  closed 
form  for  even  a  complex  MIMO  design. 
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The  design  is  based  on  the  feedback  loop  as  represented  in  Fig¬ 
ure  8.  The  plant  G(s)  has  an  input  u,  and  output  a  disturbance  d  as 

seen  at  the  output,  and  measurement  noise  vector  n.  The  compensator  is 
designated  as  K(s) . 


d 


Figure  8.  Generalized  feedback  loop. 

The  plant  G  is  the  physical  system  to  be  controlled  and  can 
therefore  behave  in  a  complex  manner,  as  implied  by  the  term  nonlinear, 
infinite  dimensional  and  time-varying  which  are  used  for  its  modeling. 

To  simplify  the  situation,  we  desire  G  to  be  linear,  finite  and  time- 
invariant  (as  results  from  the  linearization  procedure  described  in  the 
preceding  chapter),  with  a  transfer  function  £(s). 

The  design  objective  will  be  to  provide  good  command-following, 
good  disturbance  rejection,  and  small  responses  to  sensor  noise,  all 
subject  to  the  constraints  imposed  by  modeling  errors.  Hence  we  need 
large  loop  gains  in  the  frequency  ranges  where  commands  and  disturbances 
are  large  and  small  loop  gains  in  the  frequency  ranges  where  modeling 
errors  are  large,  as  well  as  a  well-behaved  crossover.  These  frequency 
domain  requirements  can  be  captured  as  shown  in  Figure  9,  where  the 
maximum  and  minimum  singular  values  of  the  loop  transfer  matrix  envelope 
the  MIMO  system  performance,  and  can  be  directly  interpreted  as  S1S0 
Bode  plots.  For  a  good  design,  it  becomes  necessary  to  use  techniques 
which  directly  take  plant  descriptions  and  performance  specifications 


Figure  9.  Frequency  domain  requirements. 

into  consideration  and  systematically  produce  a  controller  which  satis¬ 
fies  the  singular  value  requirements  of  Figure  9.  The  multivariable 
design  technique,  LQG  with  Loop  Transfer  Recovery,  is  able  to  perform 
such  a  direct  singular  value  loop-shaping. 

As  previously  stated,  the  LQG/LTR  methodology  was  developed  to 
perform  control  system  design  on  the  basis  of  time-domain  optimization. 
The  method  uses  the  following  state  space  description  of  the  plant ,  (1 : 

x  =  Ax  +  Bu  +  _C  (3.1) 

=  Cx  +  n_  (3.2) 

where  x  is  an  n-dimensional  state  vector,  u  and  ^  are  m-dimensional 
control  inputs  and  outputs,  and  and  n_  are  white  noise  processes.  The 
A,  JB ,  and  C  matrices  satisfy 


G(s)  =  C?(s)B 


(3.3) 
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where  4>_(s)  =  (S_I  -  A)  ^  .  The  feedback  design  task  is  to  find  a  control 
law  _u(t)  that  satisfies  the  specifications.  For  this  purpose,  the  math¬ 
ematics  developed  for  the  solution  of  the  following  optimization  problem 
are  employed,  although  the  design  is  geared  towards  loop-shaping  and 
clearly  cannot  claim  optimality  as  will  be  seen  in  the  sequel. 

T 

Min  J  =  J  [xT(t)Qx(t)  +  uT(t)Ru(t)]  dt  (3.4) 

0 

where  the  R  matrix  is  the  control  weighting  matrix  and  Q  is  the  state 
weighting  matrix.  The  solution  of  this  optimization  problem  is  given  by 

u(t)  =  -Gx(t)  (3.5) 

where  G  is  a  full-state  linear  quadratic  regulator  (LQR)  gain  as  defined 
in  the  Control  Algebraic  Riccati  equation  (CARE).  However,  in  the  LQG/ 
LTR  procedure,  the  solution  is  carried  out  in  two  stages.  First,  the 
filter  gain  matrix,  H,  is  found  by  solving  the  Filter  Algebraic  Riccati 
equation  (FARE) . 

The  objective  in  this  first  step  is  to  shape  the  singular  values 
of  the  Kalman  filter  (filter  gain)  matrix  according  to  the  specifica¬ 
tions,  as  suggested  in  Figure  9,  and  then  recovering  the  same  loop 
transfer  matrix  shape  for  the  singular  values  of  the  overall  system  loop 
transfer  matrix  T(s),  which  includes  the  plant,  any  augmentation,  and 
the  controller  gain  matrix  G,  which  is  obtained  as  a  second  stage  solu¬ 
tion,  by  solving  the  CARE,  for  a  given  filter  design.  This  compensator 
structure  is  referred  to  as  a  Model  Based  Compensator  (MBC) ,  because  it 
makes  explicit  use  of  the  plant  linear  mode]  (i.e.  A,  B,  £  matrices). 

At  the  end  of  the  second  stage,  the  overall  system  matrix  is  obtained  as 

T(s)  =  Gp (s)K ( s)  (3.6) 
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where  K(s)  =  G(SI_  -  A  +  BG  +  HC)  *“H .  Once  the  shape  meets  the  design 
specifications,  we  are  further  guaranteed  that  the  poles  of  [A  -  HC]  and 
[A  -  BG]  will  lie  in  the  left  half  plane,  i.e.,  no  instabilities  will  be 
introduced  into  the  nominal  system,  provided  [A,  Bj  are  stabilizable  and 
[A,  C]  detectable. 

3 . 2  Modal  Analysis 

Since  this  thesis  emphasizes  primarily  the  influence  of  the  MDS 
configuration,  the  decision  was  made  not  to  address  the  effect  of  the 
sailplanes.  Additionally,  the  states  psi  and  z  are  of  no  direct  inter¬ 
est  because  of  their  non-effect  on  the  other  (body)  states.  The  origi¬ 
nal  plant  A  matrix  contained  zeroes  in  the  columns  designated  for  psi 
and  z.  By  ignoring  psi  and  z,  this  reduces  the  plant  matrix  to  an 
(8  x  8)  matrix,  the  control  matrix  to  an  (8  '<  3)  ,  and  the  output  matrix 
to  a  (3  x  8).  It  then  becomes  necessary  to  determine  which  states  to 
use  for  the  purposes  of  control. 

The  MDS  arrangement  has  the  unique  potential  to  control  roll,  :, 
(and  pitch,  0)  via  D2  and  D3.  Finally,  for  the  third  variable,  turning 
velocity,  r,  (yaw  rate),  could  be  controlled  with  Dl. 

At  the  outset,  the  corresponding  poles  and  zeroes  of  the  plant 
were  determined.  The  variable  combination  <J>,  0,  and  r  provided  no  non¬ 
minimum  phase  zeroes  and  no  unstable  poles.  Table  1  lists  both  poles 
and  zeroes  for  the  open- loop  plant. 

A  modal  analysis  was  then  conducted  to  ascertain  the  relative 
controllability  and  observability  of  the  system.  To  examine  the  con¬ 
trollability  of  a  system,  one  is  interested  in  the  ability  of  (a)  parti¬ 
cular  input(s),  in  this  case,  Dl,  D2  and/or  D3,  to  control  the  (entire) 
state  of  a  system.  The  observability  of  a  system  tests  the  possibility 
of  observing  the  complete  state  of  the  system  through  a  particular  out¬ 
put,  i.e.,  r,  j  or  6.  Using  the  augmented  system  A,  !3  and  C  matrices 
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Table  1. 


Augmented  Plant  Poles 

-2 . 029353579E-02 
-4.37735771  IE-02 
-1.8039105 15E-01 
-1.84 317478 3E-01 
-6.227811 352E-0 1 
-6 . 583723063E-0 1 

-5.08503407 9E-0 1  ±  5.224757797E-01 
0.000  (Multiple  of  3) 

- 1 . OOOE-O 1  (Multiple  of  3) 

Augmented  Plant  Zeroes 

-4.421289192E-02 
-1.984634951E-01 
-2 . 583928560E-01 

(augmentation  to  be  described  in  Section  3.3),  the  corresponding  eigen¬ 
values  and  eigenvectors  were  calculated  and  a  modal  analysis  performed 
in  order  to  study  the  controllability  and  observability  properties  of 
the  system.  The  eigenvalues  give  the  response  time  of  a  system's  modes 
while  the  eigenvectors  represent  the  relative  contributions  of  each 
state  to  a  particular  mode,  represented  by  the  corresponding  (normal¬ 
ized)  eigenvector.  For  example,  the  plant  can  be  described  in  state 
space  from  by, 


x  =  Ax  +  Bu  (3.7) 

=  Cx  (3.8) 


51 


If  we  let  x  =  Tz_,  for  any  nonsingular  T,  we  can  define  a  new  system. 
However,  one  must  remember  that  ^  does  not  describe  the  physical  state 
space.  T  can  be  chosen  to  be  the  matrix  of  eigenvectors.  Using  this 
change  of  variable  transformation,  one  gets  that  x  =  T\z.  So  if  one 
makes  this  change  of  variable  substitution  into  the  state  space  equa¬ 
tions  (3.7)  and  (3.8),  one  is  left  with 

x  =  T_z  =  ATz  +  B_u  (3.9) 

V  =  CTz.  (3.10) 

To  complete  the  transformation,  T  is  multiplied  through  (3.9)  and 
(3. 10)  thus  yielding 

1  =  T_1ATz  +  T~ 1 Bu  (3.11) 

The  net  effect  of  the  above  procedure  is  the  diagonalization  of  the 
state  equation  where  the  elements  on  the  diagonal  correspond  to  the 
eigenvalues  of  the  system,  if  they  are  distinct.  Rewriting  the  modal- 
domain  state  and  output  equations  for  MIMO  system,  one  gets 

•  k 

z_  -  \z_  +  13  u  (3.12) 

X  =  C*z  (3.13) 

*  _  ]^  * 

where  jB  =  T  13,  £  =  CT,  and  A  is  a  diagonal  matrix  of  eigenvalues. 

For  a  system  to  be  controllable  by  an  input  u  or  observable  by  output  \r, 

*  k 

the  column  matrix  j3  or  the  row  matrix  C  must  not  contain  zeroes  in  a 
SISO  setting.  In  a  MIMO  setting,  if  zeroes  appear,  then  there  must  be 
at  least  one  nonzero  entry  in  the  B  matrix  and  one  nonzero  entry  in  the 
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C_  matrix  for  a  particular  state  to  be  controllable  and  observable  by  at 
least  one  corresponding  input  or  output. 

Another  method  could  be  used  to  determine  the  degree  of  control¬ 
lability  and  observability  for  a  MIMO  system  and  that  is  the  rank  meth¬ 
od.  If  one  forms  the  matrices 

[B,  AB,  A2B,  ....  An_1B] 


and 


C 

CA 


CA 


2 


and  their  rank  is  equal  to  the  order  if  the  system,  then  the  system  is 
both  controllable  and  observable.  If  the  rank  is  less  than  the  order  of 
the  system,  then  that  difference  is  the  number  of  uncontrollable  and 
unobservable  states  [II].  Appendix  F  contains  the  eigenvalues  (exclud¬ 
ing  augmentation)  and  the  corresponding  eigenvector  matrix,  TEMP.  The 

matrix  A_  is  the  diagonalized  modal  domain  matrix  with  the  eigenvalues 

*  * 

located  along  the  main  diagonal.  The  new  B^  and  (I  matrices  are  also 
included  and  one  can  observe  that  n<3  zeroes  exist  in  either  matrix. 

Thus  one  can  conclude  that  control  inputs  Dl,  D2 ,  and  D3  can  each  con¬ 
trol  all  the  states  of  the  plant  while  the  entire  state  vector  can  be 
observed  by  any  of  the  r,  f>,  and  3  outputs. 
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3.3  System  Augmentation 

Before  setting  off  to  design  a  compensator  for  the  control  sys¬ 
tem,  one  must  examine  the  behavior  of  the  plant  singular  values.  Fig¬ 
ure  11  shows  the  open  loop  singular  values  with  the  system  augmented 
with  an  integrator  for  each  input .  In  order  to  further  improve  the 
model,  one  must  take  into  account  the  actuator  dynamics.  Actuators  are 
normally  modeled  as  second  order  systems,  however,  when  one  takes  into 
account  the  high  damping  in  a  real  actuator,  one  can  then  approximate 
the  dynamics  of  the  actuator  as  a  first  order  system.  Pictorially  this 
situation  looks  like  Figure  10. 

The  state-space  equations  for  this  open  loop  representation  are: 


X 

— 

A  x 

+ 

B  u 

(3.14) 

— 0 

-p-p 

-p-p 

y 

C  x 

(3. 15) 

-p-p 

X 

_ 

A  x 

+ 

B  u 

(3. 16) 

—a 

-a— a 

—a— a 

V 

C  x 

(3.17) 

—a— a 

X  — 

. 

Ax 

+ 

Btut 

(3.18) 

“I 

—I— I 

—I— I 

*1 

= 

—I— I 

(3. 19) 

1 
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Combining  the  above  and  putting  into  matrix  form,  one  gets 


* 

_ 

— 

—  — 

r»  _ 

r  *i 

X 

A 

B  C 

0 

X 

0 

u 

“P 

“P 

-p-a 

-p 

HP 

X  = 

X 

— 

0 

A 

B  CT 

X 

+ 

0 

u 

—a 

— a 

—a— I 

—a 

—a 

X- 

0 

0 

At 

xT 

bt 

uT 

m—lm 

—I  _ 

~Im 

—I 

L-i 

[^P 


0  0] 


‘xl 

~P 


X 

—a 


The  modeling  of  each  actuator  to  a  first  order  approximation  will 
be  of  the  form 


G 

a 


1 

TS  +  1 


S  + 


X 

a 

u 


(3.20) 


Therefore 


Sx 

a 


ju 

t 


(3.21) 


In  state  space  form,  this  will  be  represented  as 


x 


a 


(3.22) 


55 


For  a  system  with  three  control  surfaces,  in  matrix  form,  we  get 


The  addition  of  three  integrators  is  needed  to  provide  high 
enough  gains  at  low  frequencies  for  good  command  following  and  disturb¬ 
ance  rejection. 


(3.23) 


Thus  for  each  control  variable  Xj.s  =  u  or  x^.  =  u.  Then  for  a  system 
with  three  control  inputs,  the  associated  matrices  will  look  like 
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The  augmented  system  in  state-space  form  is  consequently  given  by 


— 

— 

— 

— 

^p(8  x  8) 

(8 

B  C 
— P— a 

x  3)  (3  x 

3) 

(8 

0 

X 

3) 

(8 

0 

< 

3) 

_  J. 

X 

0 

0 

J. 

i 

0 

0 

0 

0 

1 

0 

0 

_1_ 

0 

x  + 

0 

(3  x  8) 

X 

_1 

X 

X 

(3 

X 

3) 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

(3  x  3) 

(3  x  3) 

0 

0 

0 

0 

0 

1 

£ 


"0  0 
0  0 
0  0 


0  0 
0  0 
0  0 


0  L 
0  0 
0  0 


0  0 
1  0 
0  1 


0 

(3  -  3) 


0 

(3  -  3) 


Note  that  the  c^  matrix  was  not  included  in  the  output  matrix  because 
the  desired  outputs  are  r,  and  0. 


The  time  constant,  r,  is  defined  as  — r  [12].  Recall  that  the 

w 

projected  crossover  frequency  is  about  0.1  radian  per  second  so  as  to 
avoid  the  natural  frequency  of  ocean  waves  of  0.14  radians  per  second. 

A  typical  value  for  the  natural  frequency  and  damping  ratio  for  an  actu¬ 
ator  is  3.14  radians  per  second  and  y  =  0.9.  The  resultant  time  con¬ 
stant  for  the  actuator  then  becomes  0.354  sec.  This  is  clearly  above 
the  desired  bandwidth.  It  was  consequently  decided  to  ignore  the  actu¬ 
ators  and  instead  use  lag  compensation  at  0.1  radians  per  second  to 
improve  roll-off  near  crossover.  This  will  have  the  effect  of  making 
the  vehicle  less  susceptible  to  modeling  errors  and  high  frequency 
noise.  Therefore,  the  system  is  augmented  with  three  lag  compensators 
whose  dynamics  are  as  shown  in  Figure  12. 
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FREQUENCY  (rad/s) 


Figure  11.  Singular  values  of  open  loop  plant 


Figure  12.  First  order  lag  compensator. 


3.4 


Controller  Design 

The  method  employed  to  design  the  controller  uses  the  Model-Based 
Compensator  approach  [13].  Two  very  important  points  must  be  kept  in 
mind.  First,  the  controller  must  be  able  to  maintain  the  stability  of 
the  closed  loop  system  and,  secondly,  be  able  to  achieve  desirable  sin¬ 
gular  value  loop  shapes,  in  the  frequency  domain  which  translate  to 
performance  specifications.  This  can  be  achieved  by  appropriately  shap¬ 
ing  the  system  singular  values  in  a  manner  analogous  to  the  single  in¬ 
put-single  output  Bode  plot  shaping.  Pictorially,  the  controller  and 
system  look  like  Figure  13.  Figure  14  illustrates  the  state-space  de¬ 
scription  of  the  Model-Based  Compensator,  K(s) ,  and  the  open-loop  plant, 
G  (s).  It  should  be  noted  that  the  A,  B,  and  C  matrices  that  appear  in 

_p  —  -  - 

the  plant  also  appear  in  K(s)  in  a  similar  fashion  and  thus  the  term 
"model-based . " 


d  (s) 


Figure  13.  Feedback  structure  of  a  MIMO  control  system. 
The  dynamics  of  the  open  loop  plant  can  be  written  as 


x(t) 

=  Ax(t)  +  Bu(t)  +  Ld(t) 

(3.25) 

x(t) 

=  Cx  (t) 

(3.26) 

The  open-loop  transfer  matrix  is  then 


=  C(SJ_  -  A)  !B 
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Gp(s) 


(3.27) 


so  that 


£(s)  =  Gp(s)u(s)  (3.28) 

The  Model  Based  Compensator  dynamics  utilizes  the  state  vector  jz(t) 
which  has  the  same  dimension  as  the  plant  state  x,(t).  The  dynamics  of 
the  MBC  can  be  written  as 


z(t) 

=  Az(t)  + 

Bu(t) 

+  Hv  (t ) 

(3. 

.29) 

v(t) 

=  -e(t)  - 

Cz(t) 

=  y_(t)  -  Cz(t)  -  r(t) 

(3. 

.30) 

u(t) 

=  -Gz (t) 

(3. 

31) 

In  the  above,  the  augmented  dynamics  of  the  plant  as  described  by 
Eq.  (3.24)  are  used.  Combining  the  above  three  expressions  we  get 

£(t)  =  [A  -  BG  -  HC]z(t)  -  He(t)  (3.32) 

Thus  the  input  to  the  controller  is  the  error,  £(t)  and  the  output  is 
u(t) .  The  input-to-output  relation  can  be  written  as 

u(s)  =  K(s)e(s)  (3.33) 

where  K(s)  =  G(sl  -  A  +  BG  +  HC)  ^H.  If  one  uses  an  appropriate  change 
of  variable,  one  can  determine  the  stabilizing  nature  of  the  gain  ma¬ 
trices  G  and  H.  The  appropriate  variable  change  is 

w ( t )  =  x(t)  -  z(t)  (3.34) 

•  *  • 

It  follows  that  w(t)  =  x(t)  -  z^(t).  After  making  the  appropriate  sub- 

•  • 

stitution  for  x(t)  and  z(t),  one  is  left  with 
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(3.35) 


w(t)  =  [A  -  HC ]w(t)  +  Ld(t)  -  Hr (t) 

This  resulted  in  the  decoupling  of  the  dynamics  of  w(t)  from  that  of 
x(t) .  Then  x(t)  can  be  written  as 

x(t)  =  [A  -  BG]>c(t)  -  BGw(t)  +  Ld(t)  (3.36) 


The  dynamics  of  the  closed-loop  system  in  matrix  form  is  then  given  by 


-BG 

A  -  HC 


x(t) 

w(t) 


o' 

'd(t)' 

-H 

_r(t)_ 

The  eigenvalues  of  the  closed  loop  matrices  [A  -  BG]  and  [A  -  H£]  con¬ 
stitute  the  system  poles.  Therefore,  the  det  (XI  -  A  +  BG)  and 
det  (XI  -  A  +  HC)  provide  the  needed  insight  into  the  stability  of  the 
closed-loop  system.  In  order  for  the  closed-loop  system  to  be  stable 


Re\  [A  -  BG]  <0;  i  =  1,  2,  ...,  n  (3.37) 


and 


ReX  [A  -  HC]  <  0;  i  =  n+1,  n+2,  ...,2n 

If  we  are  given  matrices  A,  15  and  £  with  [A,  B]  stabilizable  and  [A,  C] 
detectable,  then  matrices  G  and  H  exist  that  stabilize  the  open  loop 
system,  i.e.  [A  -  HC]  and  [A  -  BG]  are  stable.  The  methodology  used  to 
calculate  G  and  H  is  outlined  in  sections  3.5  and  3.6  [13,  14].  This 
provides  in  fact  the  underlying  mathematical  basis  of  the  LQG/LTR  ob¬ 
tained  solutions. 
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3.5 


The  Filter  Gain  and  Control  Gain  Matrices 


It  can  be  seen  from  Figure  14  that  the  filter  and  control  gain 
matrices  are  the  heart  of  the  MBC.  In  essence  the  Kalman  filter  gain 
matrix,  H,  is  the  input  matrix  into  the  MBC  taking  the  error  input 
through  the  MBC  dynamics,  which  in  turn  passes  it  through  the  integrator 
having  first  multiplied  the  outputs  by  the  appropriate  gain  matrix  G. 
This  then  generates  the  appropriate  control  input  for  the  plant. 

The  G  and  H  matrices  serve  a  very  useful  purpose.  Recall  from 
Section  3. 1  that  the  desired  plant  output  is  modeled  via  singular  val¬ 
ues.  Setting  the  shape  of  the  desired  plant  open  loop  singular  values 
is  important  for  good  command  following,  disturbance  and  noise  rejec¬ 
tion.  Once  the  designer  has  achieved  a  shape  that  meets  the  open  loop 
specifications,  it  is  important  to  realize  them  next  in  a  closed  loop 
configuration.  The  feedback  configuration  has  the  advantages  of  reduced 
sensitivity  to  external  disturbances,  as  a  result  of  a  course  change — 
for  example,  depth  change,  as  well  as  meeting  the  specifications  of  good 
command  following  and  other  noise  and  modeling  uncertainty  reduction. 
Through  the  clever  iterative  selection  of  the  H  and  C  matrices  via  the 
LQG/LTR  procedure  this  can  be  attained.  Section  3.6  will  detail  how 
this  selection  is  made. 

3 . 6  Loop  Shaping 

This  section  will  outline  the  procedure  that  was  followed  in 
designing  the  LQG-based  controller  with  Loop  Transfer  Recovery  [I4j.  A 
plot  of  the  open  loop  singular  values  of  C_ (S I_  -  A)  is  given  in  Fig¬ 
ure  11.  Since  there  are  three  controls  and  three  outputs,  there  are 
three  lines  of  singular  values.  As  one  can  see,  there  is  significant 
separation  between  the  maximum  and  minimum  singular  values.  It  is  de¬ 
sirable  that  all  three  behave  as  close  as  possible  in  a  tight  controller 
design. 
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The  first  step  is  to  shape  the  open  loop  plant  singular  values  so 
they  meet  the  desired  specifications  of  good  command  following,  stabil¬ 
ity  and  performance,  as  well  as  noise  and  disturbance  rejection.  This 
is  done  by  tying  the  maximum,  middle,  and  minimum  singular  values  to¬ 
gether  at  high  and  low  frequencies.  To  achieve  this,  one  must  form  the 
matrix 

— FOL(s>  =  -(S-  "  -)_I-  (3-38) 

where  is  an  arbitrary  matrix  that  can  be  manipulated  by  the  designer 
to  ultimately  give  the  desired  loop  shaping.  For  system  at  hand,  we 
form, 

"(SI.  -  A*) 

(SI  -  A)  = 

0 


where 
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and 


1* 


0 

(8  x  3) 

0 

1_ 

T 


Note,  the  A  matrix  of  (S^I  -  A)  came  from  Section  3.3.  The  inverse  of 
(SI  -  A)  is 


(SI  -  A) 


(SI.  -  A*) 


-l  I* 

—  (SI  -  A*) 

I 

S 


The  L  matrix  can  be  broken  up  into  two  components  L ^  and  L?  where 

x  ^  and  x  For  f°w  frequency  shaping,  SI_  is 

approximately  zero.  With  that  approximation  and  forming  £pQL(s) »  one 
gets 


"  -1  ~\ 

-I  "A*  B* 

“  ” 

‘i  ’  '£<3  x  LI)  2) 

-A.  - 

—*  s 

L, 

I 

-1 

T 

0  Z 

-2 

.  -  s  . 

(3.39) 


where  C  is  a  (3  x  11)  matrix  with  identity  in  positions  (1,  6),  (2,  7), 
and  (3,  8)  corresponding  to  the  states  to  be  controlled  r,  ij> ,  and  3. 
Expanding  (3.39)  yields 
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(3.40) 


C (SX  -  A)  LL  = 


-1  -11-*  1*^2 

1  1— *  -1  S 


But  for  small  s,  low  frequency,  the  second  term  in  (3.40)  dominates  the 

-1  11— *  -*^2 

first  term.  So  £(S_I  -  A)  L  can  be  approximated  by  - - - .  Then 

to  tie  the  singular  values  together  at  low  frequencies  we  also  have 
I_ 

— FOL (s)  =  S*  Therefore 


L2  =  -(c11a;1b^)“1 


(3.41) 


For  high  frequencies,  one  can  approximate  (S_I  -  A)  by  S^.  Using 
the  same  procedure  as  above. 


C(SI  -  A)  lL 


[^11 


(SI) 


-1 


I* 

T  (s^ 


-l 


h, 


(3.42) 


Expansion  of  (3.42)  yields 


C(S1  -  A)  LL 


—11—1  +  -1 1-^2 


(3.43) 


As  S  gets  large,  high  frequencies,  the  second  term  in  (3.43)  will  be 
dominated  by  the  first  term.  So  will  be  equal  to 


h 


(3.44) 
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The  combination  of  and  L0  now  constitutes  the  I.  matrix  of  the 
overall  system.  The  I.  matrix  provides  loop  shaping  and  is  totally  under 
the  designer's  control  as  a  free  design  parameter.  Figure  15  shows  the 
result  of  the  initial  open  loop  shaping.  This,  in  turn,  provides  the 
desirable  system  profile  which  the  closed  loop  compensated  system  should 
match.  The  resulting  L_  matrix  can  be  found  in  Appendix  G.  In  order  for 
the  crossover  frequency  to  be  less  than  the  critical  crossover  frequency 
of  0.1  radians  per  second,  (natural  sea  spectrum  is  at  0.14  radians  per 
second),  it  was  necessary  to  multiply  the  L  matrix  by  a  scalar  of  0.05. 


ul 


Figure  15.  Singular  values  of  G  ( j . ) . 

FOL 

The  next  step  in  the  controller  design  is  to  determine  the  filter 
gain  matrix,  H.  To  do  this  one  solves  the  Filter  Algebraic  Riccati 
Equation  (FARE). 
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0 


(3.45) 


T  1  T  -1 

=  ZA  +  A1 1_  +  5  -  ZC  6_  CZ 

where  is  an  arbitrary  (m  *  m)  symmetric  and  positive  definite  matrix 

(equal  to  the  identity  here)  and  normally  the  process  noise  covari- 

T 

ance  matrix  is  now  replaced  by  LL  .  The  solution  to  the  FARE  is  the 
(n  *  n)£  matrix.  The  filter  gain  matrix  is  given  by, 

1  T  -1 

H  =  ^  EC  E  (3.46) 

If  one  plots  the  singular  values  of  the  Kalman  filter, 

0i(-KF(j-))  =  (3.47) 

then  they  should  pattern  the  profile  of  the  singular  values  of 
Figure  16  shows  the  similar  profile.  The  DC  gains,  crossover  frequency, 
and  band  crossover  bandwidth  are  approximately  the  same.  If  it  becomes 
necessary  to  adjust  the  DC  gain  and  crossover,  this  can  be  accomplished 
by  selecting  another  free  parameter  p,  in  Eqs.  (3.45)  and  (3.46). 

The  final  step  in  the  controller  design  is  to  solve  the  Control 
Algebraic  Riccati  Equation  (CARE)  to  obtain  the  control  gain  matrix,  G. 
The  CARE  looks  like 

0  =  -KA  -  ATK  -  %£_  +  KBR~1BTK  (3.48) 

where  K  is  an  (n  *  n)  solution.  The  R  matrix  is  an  (m  *  m)  positive 
definite  matrix  (identity  for  our  purposes),  and  the  Q  matrix  is  given 
by 


Q  = 


T 

c  c 


(3.49) 
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T  (s) 


Gp(s)K(s) 


(3.51b) 


G(s)  is  the  plant  transfer  matrix  defined  by 


G(s)  =  Gp(s)Ga(s) 


(3.52) 


as  illustrated  in  Figure  7. 
by: 


In  the  frequency  domain  K.  „(s) 


is  given 


KlqG(s)  =  G(SI  -  A  +  BG  +  HC )  LH 


(3.53) 


Figure  17  is  a  plot  of  the  singular  values  of  the  compensated  system 
T(s) .  A  value  of  1000  was  used  for  q  so  that  the  three  individual  con¬ 
trol  singular  values  coincide.  It  is  apparent  by  comparing  c.(T(j.)) 

with  o  (G  (j'.o))  that  the  DC  gains  are  equal  and  crossover  occurs  at  the 
1  — Jvr 

same  frequency.  The  roll-off  past  crossover  is  desired  as  illustrated 
in  Figure  9. 

A  check  was  made  to  determine  if  the  controller,  K(s)  introduced 
any  instabilities  into  the  system.  Table  2  is  a  listing  of  poles  and 
zeroes  which  indeed  corroborates  the  fact  that  the  design  has  resulted 
in  a  stable  system.  Appendix  H  contains  the  A,  £,  £,  G,  H  and 
(A  ~  ~  HC)  design  matrices  that  will  also  be  used  in  the  simulation 

as  described  in  Section  4.1. 
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Figure  17.  Singular  values  of  T(j . ) . 
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Table  2.  Poles  and  zeroes  of  K(s). 


Unique  Poles 
Number  Real 

1  -4 . 42 1 31 7785E-02 

2  -1 . 984642130E-01 

3  -2. 515003179E-01 

5  -2 . 28357244 7E-01  2 

7  -3. 12 1226887E-01  7 

8  -8 . 357975 180E-0 1 

10  -8. 470467465E-01  3 

12  -4. 856380807E-01  1 

14  -1 . 2022 1261 9E+00  5 


Unique  Zeroes 


Number 


1  -2 . 4 18544925E-02 

2  -4. 342940086E-02 

3  -9. 122782906E-02 

4  -1 . 062659914E-01 

6  -1.47 1 524383E-0 1  -7 

7  -1 . 852788869E-01 

8  -5 . 245929103E-0 1 

9  -6 . 230977444E-0 1 

11  -5. 17940 1036E-0 1  4 


Imag 


689624484E-01 
20046648 1E-0 1 

.  140172344E-01 
.2211 596 15E+00 
654424752E-0 1 


231643907E-02 


323091 793E-0 1 
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CHAPTER  4 


COMPENSATOR  PERFORMANCE 


4. 1  Model  Simulation 

The  model  simulation  used  to  test  the  controller  involves  the 
integration  of 


_z(t)  =  (A  -  BG  -  HC)z(t)  -  He(t) 

where  «i(t)  is  the  error  vector  defined  by 

e(t)  =  r(t)  -  ^(t) 

To  close  the  loop,  one  can  either  select  the  linear  model  or  nonlinear 
model  as  developed  in  Chapter  2.  It  is  expected  that  the  linear  model 
will  give  good  results  with  the  nonlinear  model  giving  acceptable  re¬ 
sults  because  the  controller  was  designed  from  the  linear  model  origin¬ 
ally. 

4. 2  Simulation  Results 

Now  that  the  controller  has  been  designed,  it  is  necessary  to 
test  its  performance.  Recall  that  the  motivation  behind  this  thesis  was 
twofold:  (i)  design  a  controller  from  a  linear  model  and  (ii)  test  it 

on  a  nonlinear  model,  controlling  r,  <J>,  and  0  in  a  turn. 
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The  first  test  simulation  run  purpose  was  to  check  if  the  con¬ 
troller  would  be  able  to  achieve  zero  steady  state  error  with  a  command 
reference  input  of  -0. 368482E-02  rad/s,  the  nominal  r  value,  and  zero 

for  both  4>  and  0,  keeping  in  mind  that  the  open  loop  roll  for  the  same 

-2 

condition  was  1.5  degrees  and  0  4.0  *  10  degrees.  With  the  closed 
loop  simulation,  both  <f>  and  9  indeed  went  to  zero. 

A  second  simulation  run  was  made  to  command  a  condition  that  was 
other  than  the  nominal  r.  A  turning  velocity  equivalent  to  a  5  degree 
nominal  rudder  deflection  was  commanded  with  zero  again  for  $  and  0. 

The  open  loop  <j>  and  0  for  this  condition  were  5.5  degrees  and  2.5  de¬ 
grees  respectively  with  the  controller,  r  went  to  the  commanded  value  of 
-0.1160E-02  rad/s,  and  <j>  and  0  went  to  zero.  With  both  simulation  runs, 
the  controller  achieved  zero  steady  state  error  for  the  three  command 
inputs.  Figure  18  contains  the  open  loop  r,  <J>  and  9  response  runs  and 
the  closed  loop  simulation  response  with  command  input  of  -0 . 368482E-02 
rad/s,  0°,  and  0°  for  r,  <p  and  0  respectively.  Figure  19  likewise  shows 
the  open  and  closed  loop  responses  for  r  =  -0.1160E-01  rad/s  and  zero 
for  <()  and  0 . 

One  additional  benefit  of  the  controller  can  be  seen  with  depth, 
z.  Without  the  controller,  both  open  loop  simulations  exhibited  contin¬ 
uous  depth  change  throughout  the  run.  With  the  controller,  the  vehicle 
sank  a  small  amount  but  steadied  as  the  run  continued.  Therefore  the 
controller  was  able  to  stabilize  depth  loss  even  though  depth  was  not  a 
control  variable. 
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OPEN  LOOP  RESPONSE 


TIME 


a  \ZJ  130  2..0  -iO 


TIME 

Figure  18.  Open  and  closed  loop  simulation  responses  with 
command  input . 

r  =  -0. 368482E-02  rad/s 

$  =  0° 

9  =  0° 
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Figure  19.  Open  and  closed  loop  simulation  responses  with 
command  input . 

r  =  -0.1160E-01  rad/s 


CHAPTER  5 


CONCLUSIONS  AND  RECOMMENDATIONS 


The  LQG/LTR  method  can  be  successfully  used  to  design  a  control¬ 
ler  from  a  linear  model.  Additionally  the  resulting  controller  is  able 
to  perform  acceptably  with  zero  steady  state  error  on  a  nonlinear  model, 
which  more  closely  approximates  the  real  world  system. 

The  MDS  configuration  has  demonstrated  improved  ability  over  the 
conventional  cruciform  stern  in  turning  situations.  With  the  ability  of 
the  vehicle  to  align  its  local  reference  axis  to  that  of  the  global 
system,  one  is  able  to  obtain  true  motions  of  surge,  swav,  heave,  roll, 
pitch,  and  yaw.  The  advantage  being  improved  crew  comfort  and  quicker 
computer  solutions  to  fire  control  problems. 

It  is  recommended  that  further  thesis  work  on  this  model  to  in¬ 
clude  depth  control  with  the  additional  control  surface  of  sailplanes. 

A  potpourri  of  operating  points  spanning  a  speed  range  from  b  to  21 
knots  with  rudder  deflections  of  5  to  30  degrees  will  give  on  a  feeling 
for  the  capabilities  of  the  MDS  configured  submersible.  The  addition  of 
vortex  shedding  to  the  model  will  also  improve  the  characteristics  of 
the  model  to  real  world  subraersihles .  Finally,  it  would  be  desirable  to 
design  a  controller  that  could  negotiate  ordered  changes  in  depth.  With 
gain  scheduling,  the  model  could  clearly  be  used  as  a  training  aid  in  a 
simulation  laboratory. 
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APPENDIX  A 


MASS  PROPERTIES 


Mass 

Weight 

Buoyancy 

75,483  slugs 

2,428,300  lbf 

2,428,300  lb f 

Ixx 

iyy 

Izz 

2 

3,019,300  slugs-ft 

123,790,000  slugs-ft 

123,790,000  slugs-ft 

Ixy 

Ixz 

Iyz 

0. 

0. 

0. 

XG 

YG 

ZG 

0. 

0. 

1.0  ft 

XB 

YB 

ZB 

0. 

0. 

0. 

Xstern 

S length 

-89.75  ft 

180  ft 
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APPENDIX  B 


mu 


NONLINEAR  EQUATIONS  OF  MOTION 


Axial  Force  Equation 

•  •  2  2 

-  myGr  +  m2cq  =  mvr  -  mwq  +  mxG(q  +  r  )  -  myGpq  -  mzGpr 

+  y  2.4 fx '  q2  +  X’  r2  +  X'  rpl 
2  l  qq^  rr  rp 

+  y  £  |X* 'u  +  X'  vr  +  X'  wql 
2  [_  u  vr  wq  J 

+  y  SL2\x'  u2  +  X'  V2  +  X’  w2] 

2  L  UU  vv  ww  J 

+  |lZ“2[XL(Dl2  +  D22+D32)+X8b6bSb] 

+  i2u2  jjzhrcst  +  b^n  + 

+  y  2.2  (n  -  1)|X*  u2(D12  +  D22  +  D32)  +  X'  v2  +  X’ 

2  L  Mu  vvr;  VwT 

-  (W  -  B)  sin  9  -  drag 
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Lateral  Force  Equation 


mu 


mz„p  +  mx.r  = 


2  2 

mwp  -  mur  +  myG(r  +  p  )  -  mz^gr  -  mxGqp 
+  *  *P  +  Y-'r  +  Y  *  ,  |  p  I  p  I  +  Y'  pq  +  Y*  qr 

2  |_PH  r  pIpT  pq^H  qr^  J 

+  £-£3|Y-'v  +  Y'  vq+Y'  wp  +  Y'  wr  +  Y’ur+Y'up 
2  L  v  vq  H  wp  ^  wr  r  P 

+  Y| r | 6u| r| (D1  -  0.6088D2  +  0.6088D3) 


+  Y' 


v  r 


V  (v2  +  w2)2|rj  +  Y*  ur(n  -  1) 


M 


rn 


[n*2  + 

Y’ 

V 

uv  +  Y 1  |  r 

vjv| 

4-  V  1  - 

vwu 

T  I 

vw 

V 

n 

u 

.2,2 
+  V  +  w 

2,2 


.  6088D3) 


1_ 

2,2 


+  q-  l2(n  -  1)[y'  uv  +  Y'  i  I  v(v2  +  w2) 
2  L  vn  v|v]n 


+  Y'tiu2(D1  -  0.6088D2  +  0.6088D3) 


+  (W  -  B)  sin  <t>  cos  9 


-  I-  £2 


ww 


2  /  D(x)  dx 

£  £ 


1 

J"H(x)v(x)  |[w(x)  ]2  +  [v(x)]2p  dx 


-  £.  £2 
2 


vv 


fw 


(x  ~  “  X  ) 

fw  so  X 


/ 


w(x)vc  (t  -  t(x))  dx 
fw 


vs 
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Normal  Force  Equation 


raw  -  rax^q  +  my^p 


2  2 

muq  -  mvp  +  mz  (p  +  q  )  -  nx  rp  -  my  rq 
G  G  G 


fv 


+  y  J,4  Z-'q  +  Z' 

2  q  P  |  P  ( 


2 

P  .u 


+  Z'  ,  i 
r  |  r  | 


2 

r  u 


1  2  2  2  1  1  Hi  2  2 

Vu  +  v  +  w  n/u  +  V  +  w 


+  Z' 

rp 


rpu 


J  2  .  2  2 

V  u  +  v  +  w 


+  -  £3 

2  * 


Z- ’w  +  Z'  — 
w  vr  I— 

n/  u 


vru 


2  ,  2  .  2 
+  V  +  w 


+  Z  '  vp  +  Z  '  uq 

\7  r\  4  ^ 


vp 


+  Zlq i^ujqj (-0.7934D2  -  0.7934D3) 


+  -r~r'  (v“  +  )  2  !  q  .  +  Z'  uq(n  -  1) 

w  q  ;  w  j  Ini  qp. 


,2{i>2  * z; 


2  2  0  *  i  i 

uw  +  Z'i  | w (v  +  w  ) “  +  Z |  u [ w  j 

wjwj  I w I  1 


+  Z’  ,  I 

V  V 


2 

V  U 


J  2  .  2  2 

'J  U  +  V  +  w 


+  Z^u“(-0.7934D2  -  0.7934D3) 


+  Z’  u2<5,  +  Z’  !w|n/v2  +  w2 
ob  b  ww 1 


P.  ,2, 


[, 


2  ,  2.2 


+  7  (n  -  1)  Z’  uw  +  Z ’  |  I  w(v  +  w  ) 

’  1  wn  w  I  w  I  n 


2, 


+  Z^u  (-0.7934D2  -  0.7934D3)j  +  (w  -  B)  cos 


>1- 


COS  7 
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90 


Rolling  Moment  Equation 


myGw  -  mzGv  = 


-I  P  -  (I,_  -  Ivv)gr  +  (r  +  pq)Ixz  ~  Cr2  -  q2)I  -  (pr  -  q)I, 
xx  zz  yy  xz 

+  my  uq  -  my  vp  -  mzGwp  +  mz„ur 


+  f  ^[Kp’P  +  Kr’^  +  Kqrqr  +  KpqPq  +  Kp!p|P,P|] 

+  |  *4[kJ«P  +  KUt  +  Kv’'"  +  K^qVq  +  ^  +  KwrWr] 

+  2  +  K^uv  +  K^|v|V(v2  +  w2)2  +  K^vw  +  K^u2(D1  -  D2  +  D3) 

+  K*  u2(n  -  1)  -  Propt  +  (u2  +  v2  +  w2) 

(k4SS2  sin  4(<j>s  -  37.5)  +  K8S  sin  8  0g  -  37.5)) 

+  [(yGw  -  ygB)  cos  0  cos  5  -  (zQw  -  zRB)  cos  0  sin  •;] 


+  |  f  w<x>vf„(t  "  Tx)  dx 


+  j  i3(u2  +  v2  +  w2) 

[k48B28  Sin  (4(*s  -  37.5°))  +  S2Kgs  sin  (8($£ 


-  37.5°)) 


v  -  v  +  x  r 
s  s 


w  =  w  -  x  q 
s  s^ 
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Pitching  Moment  Equation 


mz.u  -  mx  w  = 
G  G 


mz„vr 


-  mz  wq  -  mx  uq  +  mx  vp  -  I  q  -  (1  -  I  )rp  +  I  (p  +  qr) 


G  G  "*  "G“'1  ’  "‘"G’‘  yy-1  '  xx  ~ zz'  ■  xy 


W"'  -  r2>  -  'yz(qP  - 


+  2.  i5  M*’q  +  (V  |  |  p2  +  M 1  i  ,r2\ 
2  q  \  PlPT  r(r|  / 


n/u 


-  +  M '  rp  +  M '  q  ,  q 

2  2 - 2  rp  q:q 

+  v  +  w*- 


§■  i4TM-  'w  +  M-  - XSL 

“  vt  jt—t 

V  U  +  V 


+  M 


vpu 


+  M  uq 


2  2  VP  o  o  9  q 

v+w  n/u+v+w 


+  M|q|65ulcll  (D!2  -  0.6088D22  -  0.6088D32) 


+  Mlai  5  U^q|l(0- 793402  +  0-7934D3)  +  m’w  qq(v2  +  w2)2 


+  Mqnuq (n  ~ 


+  |  «3[«;u2  +  «; 


+  M'  I 

v  v 


uw  +  M' |  |w(v2  +  w2)2  +  m'  u  w 

w|w|  '  , w, 

v2u  ? 

+  M^u~(Dl2  -  0.6088D22  -  0.6088D32) 


\/u2  +  v2  +  w2 


+  M'u2(0.  7934D2  +  0.7934D3)  +  M'  u25L  +  M’  ,'w  ^v2  +  w2 

ob  b  ww 


+  |  73(p  -  1)  M*  uw  +  M';  .  W(v2  +  W2)2 

2  j_wn  wjwjn 


+  M;.(-r_u2(Dl2  -  0 . 6088D2 2  -  0.6088D32) 


+  M' ^u2  (0 . 79  34D2  +  0.7934D3) 
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■  (xGw  “  XBB)  cos  6  cos  (j)  -  (zGv  -  ZgB)  sin  6 

f  ~ 

+  2  Cd  j  CdxD(x)w(x)|[w(x)}2  +  [v(x)]2|2  dx 
Xfw 

'  2  iCv  /  xv(x)vfw(c  -  Tx>  dx 


94 


95 


I  Cd  y'xH(x)v(x)|[v(x)]2  +  [ w(x)  ] 


fw  _ 

2.C  J*  xw(x)vP_(t  -  t^)  dx 


2  v 


vs 


fw' 
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APPENDIX  C 


LINEARIZED  EQUATIONS  OF  MOTION 


Axial  Force 


[m  -  x*]Au  -  myrAr  +  mz„Aq 


Au[2uo{Xuu  +  ai  +  bin  +  +  2uoX56(D10  +  °20  +  °3o) 

+  2uoX6b6b5bo  +  2uo(rio  ~  1)X55n(D10  +  D20  +  °3o)] 


+  Av[mr  +  X  r  +  2V  X  +  2V  (n  -  1)X,  ] 

o  vr  o  o  w  o  o  vvn 

+  Aw[-mq  +  X  q  +  2w  X  +  2w  X  (n  -  1)] 

o  wq  o  o  ww  o  wwq  o 

+  Ap[-my„q  -  mz„r  +  X  r  ] 
r  JG o  Go  rp  o 

+  Aq[-mw  +  2q  mx_  -  my„p  +  2q  x  +  X  w  ] 
o  ^o  G  ■'G  o  o  qq  wq  o 

+  Ar[mv  +  2mx_r  -  mz„p  +  2r  X  +  X  p  +  x  v  ] 

1  o  Go  G*o  o  rr  rp  o  vr  o 

-  A9[(W  -  B)  cos  9  ] 


+  46b[2SboX»b«b“o] 

“l[2Dlo{(X66uo  +  "hA".  -  '>)}] 

aD2[2D2o{(X«“o  +  -  »)}] 


Lateral  Forrg 


[m  '  YvlA^  ~  ^ZG  +  Tf*]Ap  +  [mxr_  -  Y-)Ar  = 


r  r 

[  °  +  Yrr°  +  Y°P°  +  Y|r)6^ro' (D10  "  0-6088D2q  +  0.6088D3q) 

rnro(no  1}  +  Yvu0  +  2u0{Y*  +  Y6(D10  -  0.6088D2q  +  0.6088D30) 
+  Y6n(D10  “  °-6088D20  +  0.6088D  )(n  -  1)1  +  Y  v 

JU  °  i  vn  o 

V  w  (v2  +  w2)  1 
+-  Y  — -  ■  °‘  0  o/ 


vn  o^no  ~  ^ 


vw 


H  *  \  *  «lt 

[Vo+Vwt»-O2)4^r!ro|| 


+  Y  U 
V  o 


2u2  '  2 

+  Yvlv’ 


Ho  .  YwVo(“2  +  \) 

nr~ 2  ~  - - r + 

J u  +  w  /  2  ? 

°  °  (”.*•:* »2)2 


2u2  +  w2  3Y 

+  Yv|v|n(no  -  1)  ~  +  — CRFW 

+  “o 


3v 


*  4"[”p°  +  I”pPo  +  Y”ro  +  Vi  vrr  (v„2  +  »o) 

’'I'l'.H  +  “o )  \  *  V  *  V°), 


(“o  +  \  +  »,) 

+  rv|v|„C0  -  ')%(v0H»o2)'i  .fgSij 
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+  Apfmw  +  2p  my_  -  mx_q  +  2  j  p  i  Y  i  i  +  Y  q  +  Y  w  +Yu 

r.  C1/!  fn1  nlni  nn’r)  urn  n  nr 

3Y, 


+  Aq 
+  Ar 


CRFW 

-mz_r  -  mx„p  +Y  p+Y  r+Y  v+  — t - 

G  o  Go  pq  o  qr  o  vq  o  jq 

-mu  -  mz_q  +Y  q  +  Y  w  +Yu 
o  G4o  qr4o  wr  o  r  o 


+  Ilr|6“o(DlO  -  °'6088D20  +  °-6088D30>  ~T 


+  Y  i  44  (v2  ♦  ,4  ^  +  V  u  <-  -  1)  ♦  -^1 

V  r  v  V  o  0/  r  r"  o  o  >x  I 

1  *  1  r\  '  n  w 


+  A<|>[ (W  -  B)  cos  $  cos  0  ] 


-  A0  [  (W  -  B)  sin  q  sin 


+  AD 


.  Y  |  |  .  u  ]  r  i 

1L  | r I  6  o'  o' 


+  Y  .u*"  +  Y. 

6  o  ah 


-  *>] 


+  AD0 1-0 . 6088Y ,  ,  „u  I r  !  -  0.6088Y.U2  -  Y .  u2(n  -  1)0.6088  | 

2L  I r | o  o1  o'  6  o  6n  o  o  J 

+  AdJo.6088Y,  lrU  !r  !  +  0.6088Y,u2  +  0.6088Y..  u2(n  -  1) 

3L  |  r  6  o1  O'  do  5n  o  o  J 


+  An 


[Y  ur  +  Y  uv  +  Y  |  i  v  (v2  +  w/ 
rn  o  o  vnoo  v|v|i  o\  o  o/ 

+  Y5„%(D10  -  °-6088D20  +  0-6088D30>] 


where 


3Y 


CRFW 


3v 


l.R  _ Zw _ \  f 

^  /  D  (x)  dx  JJ 


H  (x) 


(“pW  *  2Vo<*>) 

R 


dx 


(x)  +  w^(x) 
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3Ycrfw 


3q 


3YCRFW 

3r 


Zww 

f  D(x)  dx 

l 


x 


H(x)vq(x)wo(x) 
Jv^(x)  +  w*(x) 


dx 
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+  Aw 


z  III  q  W  I  (v2  +  W2)  2  +  Z  u  +  Z  °  ° 

w|q|  o  o1  \  O  O/  WO  W|W 


j  2  2 

.  V  +  w 
NO  0 


(2  2  o 

Z  |  | p  +Zi  ir  +  Z  rp  +Zi  i  v  +  Z  vr\ 
PIP|  o  r | r |  o  rp  o*o  v|v|  o  vr  oc/ 


u  w 
o  o 


(«2  +  v2  +  „2)' 

\  O  O  0/ 


+  z 


u  w 
o  o 

|„l  - r  +  Z  u  (n  -  1)  +  Z  i 

|w|  |Wq|  wn  o  o  wjwjn 


v  +  2w‘ 
o  c 


Jv  +  w' 
V  o  c 


2  2 

w  v  +  2w  3Z___, 
7  o  o  o  .  CRFW 

*  ^  “i  r  -  -r 


ww  w 


3w 


o'  [2~2 

+  Ap  -mv  +  2p  mz  -  mx  r  +  (2p  Z  i  +  z  r  ) 
l  0  °  G  G  0  \  o  PIP!  rp  of 

+  Z  v 
vp  o 

+  Aq  mu  +  2q  mz  -  my^r  +  Z  u 
L  °  Ob  'Go  qo 


2  2 

J  u  +  v  +  W 
No  O 


+  Z| _ J  *u 


q(6Uo—  (~0-7934D20  -  0.7934D30) 


+  Z 


w  |  q  | 


w 


+  Z  j  |  (q 

w  w  n  o 


o  /  2  2 

— . /v  +  w  +  Z  u 
q_  V  o  o  qn  o 

lWv2  +  v2  +  ^£mh] 
o  o  3q  J 


qq-o(no  "  :) 


{ 


+  Ar  -rap  -  my  q  +  (2r  Z  ,  ,  +  Z  p  +Z  v) 
Go  Go  o  r|r|  rpHo  vr  o' 


,  2  ,  2  2 
J  u  +  V  +  w 


CNi  O 


-  A<j>[  (W  -  B)  cos  9o  sin  <ji  ] 

-  A0[(W  -  B)  sin  0q  cos  <j>  ] 

+  a4b[zabuo] 

+  1D2[°-;934(z|,|«uol’ol  +  Vo  *  Z5„“o‘"o 

*  B3[o.7»3*(2|q|su0|qo|  +  Z5uZ  +  Zar,uJCno 


»)] 

-)] 


+  An 


[z  uq  +  Z  u  w  +  Z.  iW  (v“  +  W2)2 
L  qn  oo  wn  o  o  w|wjn  o\  o  o/ 

+  Z«„%<-°'7934D20  -  °-7934D30>] 


where 


3zcrfw 

3v 


3zcrfw 

3w 


3zcrfm 

3q 


3zcrfw 

3r 


£  (-12  _ J2 _ \  f ) 

2  l  /  D(x)  d x  I  J 

'  l  l 


w  <x)v  (x) 

D(x)  1  1 1  -  11  -  dx 

s/VoU)  +  Wo(x) 


ww 


/  D  (x)  dx 

& 


)/»<*) 


(vZ(x)  +  2vZ<*>) 


dx 


/v2(x)  +  w2(x) 


P  f-^2  _ JSL - 

2  \  /  D(x)  dx/J 

l 


x  D(x) 


(v2(x)  +  2w2(x>) 
jv2(x)  +  w2(x) 


dx 


(- 


t*-1 


f  D  (x)  dx 
l 


)/ 


D(x)wQ(x)vo(x) 
x  -  dx 


J 


V2 (x)  +  w2 (x) 
o  o 
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Rolling  Moment 

-[mz_  +  K*]Av  +  my_,Aw  +  [I  -  K*]Ap  -  I  Aq  -  [I  +K*]Ar  = 

G  v  •'G  xx  p  xy  xz  r 

4u[»V°  +  "Vo  +  V»  +  Vo  +  2”oK*  +  Vo 

+  2“oVD10  -  °20  +  D30>  *  2“o*Vn°  -  ” 

+  2"o8L(K4s  s“  4<*so  -  37'5*>  +  K8s  s1”  8<*so  -  37'5'» 


-  26  Jv2  +  w2  (K.  sin  4(0  -  37.5°) 

SoN  so  so  4s  'so 


so'v  so  "so  '“4s  ” 

+  K8s  8«so  -  37'5‘»] 


r  22 

w  +  2v 

+  Av  -my^p  +K  q  +  K  u_  +  K  |  |  — - —  +  K  w 

G  o  vq  o  v  o  v|v|  2 - 2  ™  0 

/v  +  w 
v  o  o 


+  ^8.0 «*.  sln  4(iso  -  37'5°>  +  hs  8«So  -  37'5'» 

2u  6  v 

+  — o_ so__so  sin  4(0  -  37.5°)  +  K„  sin  8(0  -37.5°)) 

/— 2 - 2  so  8s  so 

v  +  w 
V  so  o 


/  2 

CM 

CM 

f  u 

+  V  +  w 

La. 

so  so 

2,2 

W  +  V 

\ 

SO  SO  t 

8  w  (4K.  cos  4(0  -  37.5°) 

so  so  4s  so 


+  8Kq  cos  8(0  -  37.5°)) 

os  so 


+  &W  -m*Gpo  +  Kwpp0  +  Kwrro  +  Kv|v|  ---■ —  •  + 
L  Jvo  +  Wo 


K  v 
vw  o 


+  2w  3  (K,  sin  A<4>  -  37.5°)  +  KQ  sin  8(<J>  -  37.3°)) 

so  so  4s  so  8s  so 


2u  0  w 
o  so  so 


+  - - 2~  (K4s  sin  4(*so  "  37-50)  +  K8s  sin  8^so  “  37.5°)) 

^Vso+Wso 


lul  +  V2  +  w2  ) 

\  o _ so _ so  / 

/  2  ^  2  \ 

\  so  so/ 


6  V  (4K,  cos  4(<i>  -  37.5°') 

so  so  4s  vyso  1 


+  8K8s  cos  -  37.5*)) 


+  ap[Iys’o  -  Vo  '  “Vo  -  “Vo  +  V°  +  2li>0lKp|p|  + 


+  K  w  ] 
wp  o 


+  Aq I - ( I  -  I  )r  +  I 


22  ~  Vro  +  Iyzpo  -  2Vyz  +  myGUo  +  Kqrro  +  ' 


(-2u  6  x  w 

- °  °°  S°  -  2v  B2  x 

0- ~  S°S°“ 

V  SO  SO 


(K4s  sin  4(*so  -  37.5°)  +  K„  sin  8(*  -  37.5°)) 


/  2 

2 

2  \  2 

(u 

+  v  + 

w  )x  v  B 

\  O 

SO 

so/  so  so  so 

v  +  w 
so  so 


C4K.  cos  4 (4>  -  37.3°) 

4s  so  ' 


+  8K  cos  8(<p  -  37.5°)) 


+  Ar[~(Izz  "  Zyy)qo  ~  2roIyz  "  IXyPo  +  mzGUo  +  Kqrqo  +  KrUo 
20  u  x  v 

_i_  it  ..  .  so  o  so  so  , 

+  KwrWo  +  '  -  2  (kAs  sin  4(4>sq  -  37.5°) 

VVso  +  Wso 

+  K8g  sin  8<*so  -  37.5°))  +  2Sg0Vsoxgo  (K^  sin  4(^go  -  37.5°) 


w  x  B2  (u2  +  v2  +  w2  ) 
+  K_  sin  8 (<j>  -  37.5°))  +  30  so  s0'  0  so  so/ 

os  so  ' '  “  2 

w  +  v 
SO  so 
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Pitching  Moment 


mz^'u  -  [mxG  +  M^]Aw  -  IxyAp  +  [Iyy  -  M^]i4  "  Iyz -r  = 

+  Au^-mxGqo  +  Mqqo  +  M|  q  j  5,5  !  90  i  (D  10  “  0.60880^  -  0.60880^) 

+  M!q!5i%l(0-7934D20  +  °-7934D30)  +  Mqnqo(rlo  '  L)  +  2uoM* 

*  Vo  +  M|w|  l*0!  +  2“„M5«(D10  -  °'6088D20  -  8,8888D30) 

+  2Uo«6(0.7934D20  +  0.7934D3o)  +  2„oM5b~bo  +  »wr«0^0  -  D 


+  2u 


>Vn(D 


2  -  0.6088dL  -  0.6088D20) 


10 


20 


+  2»oM{n(0.  7934D20  +  0.7934DJ0)  +  («,  p  p2  +  r2 

M  ,  ,v2)  - 

V , V  I  of 


+ 


+  M  v  r  + 
vr  o  o 


mzrr  +  mx„p  +  Mi 

bO  b  O 


2  2 

v  +  w 
o  o 


/  2  .  2  2  \ 

1  U  +  V  +  w  I 

\  o  o  o/ 

q  v 

o 


w  |  q 


+  M 


v  w 
o  o 


|  2  ,  2 
Jv  +  w 
Vo  o 


W  I  W  i 


:  2  2 

Jv  +  w 
Vo  o 


-  (m  I  | p2  +  M  |  | r2) 

\  P  pro  r  |  r  ol 


U  V 

o  o 


I  2  2 

u  (u  +  w 
o '  o  o 


-r  +  M  , 

3  v  v 


/  2  ^  2  2\ 

U  +  V  +  w 
'  o  o  O' 

v  ( 2 (u2  +  W2)  +  V2) 
o'  '  O  _ O'  o  ’ 


-  +  (M  r  +  M  p  ) 
3  vr  o  vpro 

2\2 


I  2  ,  2  2\2 

U  +  V  +  w 

'  o  o  o' 


I  l  ,  l  ,  L 
U  +  V  +  w 

'  o  o  o 


2  \  2 


+  M 


w  win 


(n  -  l)v  w  w  v 

o  o  o  ,  „  o'  o 

-  +  M  - 

ww 


3M 


CRFW 


/  2  ,  : 
v  Vo  +  Wi 


I  2 


3v 


Jv  +  w 
Vo  o 
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110 


4  - ^2 - (I  -  I  )P  +  -P™ 

vr  i— j - 2 - 2  XX  zz  °  3r 

./u  +  V  +  w 

No  O  O 


+  Aij)[(x(,w  -  x^B)  cos  0q  sin  9q] 

+  A0[(x  w  -  x_B)  sin  0  cos  $  -  (z„w  -  z^B)  cos  0  ] 

v*  D  O  O  b  D  O 


+  A5bi 


K-o] 


+  AD  |2M,  |  u  [q  |D. _  +  2M..u2D.n  +  2M . .  u2Dln(n  -  1)1 
1L  j  q  j  o o  o  o  10  66  o  10  ficr,  o  10  o  J 

+AD2[-1.2176M|ql66uo!qo|D20+0.7934M|q!5uo:qo  -  1.2176M55u2D 

+  °-7934M6uo  -  1,2l76M56n(no  -  1>«oD20 


+  0 . 7934M-  u  (n  -  1) 
on  o  o 


+  AD,  -1.2176M,  |..u  jq  j  D.,,  +  0. 7934M,  cu  q  -  1 . 2  1  76M  -  -  iTD 
3L  |  q| 00  o'  o'  30  ,  q I  0  o 1 no 1  o 

+  0.7934M..U2  -  1 . 2 1 76M  (n  -  l)u2D^ 

oo  55n  o  o  30 


+  0.7934M,  u  (n  -  1) 
5n  o  o  'J 


r  22 

llM  uq  +M  uw  +  Mi  iw./v  +w 
L  qn  o’o  wn  o  o  w|w|n  oN  o  o 

+  M66.,uo(D10  *  °'6088D20  -  °'6088D»I 

+  MS,“o«>-79™20  +  °-7934"30)] 


where : 


3M 


CRFW 


3r 


ww 


3v 

2 

V"  /  D(x) 
l 

dx  y 

3Mcrfw 

P 

z 

ww 

\ 

3w 

2 

y  s  d(x) 

i 

dx  J 

3mcrfw 

P 

( i2 

Z 

ww 

3q 

2 

\  : 

i 

D(x) 

dx 

3Mcrfw 

-  P| 

{*2  _ 

Z 

ww 

)/ 


iD(x)wo(x)vq(x) 


dx 


’■JSl’O  *  »0<x) 

(»»(»)  +  2“o<»>) 

JJoo  + 


/  D(x)  dx 

l  '  l 


)/■ 

Jt 

)/ 

)/■ 


D(x) 


dx 


„  (v2(x)  +  2w2(x)) 

x2  D(x)  0 


jv2o(x)  +  w2(x) 

,  w  (x)v  (x) 

D(x)  -  °  -  °-  -  dx 

JVo(x)  +  w2(x) 


dx 
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Yawing  Moment 

-my„Au  +  [rax_  -  N*]Av  -  [I  +N*]Ap-I  Aq+[I  -  N*]Ar  = 
JG  G  v  xz  P  yz  zz  r 

Au[-mx„r  +Np  +  N  r  +  N.  i  ij:(o.7934D2  -  0.7934D2  ) 

L  Go  p*o  r  o  1 r 1 6 6 '  20  30' 

I  2  2\ 

V  W  V  +  w 

O  O'  O  O’ 


+  N 


(u2 
'  o 


3  +  N|r|6lrol(D10  -  °-6088D20  +  °'6088d30> 


+  v“  +  w 

O  O  ' 


+  N  r  (n  -  L)  +  2u  N.  +  N  v  +  2u  N  , .  (o.  7934D2  -  0.7934D2  ) 

rqo'o  o*  vo  o  66'  20  30' 

+  2u  N  (D  -  0 . 6088D.n  +  0.6088D„)  +  N  v  (n  -  1) 
o  i>  10  20  30  vp  o  o 


+  2“oNM„(%  -  1>(0-7934D2o  -  0.7934d23q) 

+  2"oN4„(no  -  '"“id  -  °-6088D20  +  0.6°88D30)] 


+  Av 


my  r  +  N  q  +  N  i  i 
JGo  vq^o  v  r 


r  v 
o  o 


I  2  .  2 

.  v  +  w 
Vo  o 


+  N  u  +  N  |  | 

vo  v  v 


,  2  .  2 
2v  +  w 
o  o 


/  2  .  2 
J  v  +  w 
v  O  o 


2  a.  2 

u  w  u  +  w 

+  N  — — - — - - — o  +  N  u  (n  -  1)  +  N  |  | 

vw  3  vqo  o  v  v  n 


/  2  ,  2  2 \2 

(u  +  V  +  w 

V  o  o  o' 


2  2 

2v  +  w 
o  o 

2  2 

V  +  w 
o  o 


3N 


CRFW 


3v 


+  Aw 


mx-p  +  my„q  +  N  r  +  N  p  +  N  >  i 
G  o  ^G^o  wr  o  wp*o  v  r 


r  w 
o  o 


I  2  2 

.  v  +  w 
Vo  o 


+  N 


V  w 
O  O 


V  V 


I  2  ,  2\ 

U  V  u  +  v 
o  o '  o  o' 


Jv2 

+  W2 

vw 

/  2 

2 

2  \ 

</  o 

0 

u 

+  V 

+  w 

*  0 

o 

0  ' 
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+  N 


(n  -  l)v  w  3N  . 
v  o _  o  o  CRFw 


v  v  n 


2  2 

iv  +  w 
I  o  o 


+  Ap[mx„w  -  (I  -I  )q  +  I  r  +  21  p  +  N  q  +N  w 
r  G  o  yy  xx  yz  o  xyro  pqo  wp  o 


+  Aq 


+  N  u  ] 
P  ° 


myGWo  - 


(I  -I)p-2Iq-Ir+Np+Nr 
yy  xx  o  xy  o  xy  o  pqro  qr  o 


+  N  v  + 


vq  o  3q 


3Ncrfw] 
3q  J 


+  Ar|-mx„u  -  my„v  +  I  p  -I  q  +  N  q  +2N.  ilr;+N  w 
■'Go  yzro  xz  o  qr^o  r  |  r ,  1  o'  wr  o 


{““Vo  “ 

+  Nu  +  N|  -r2-£  (o.7934D^n  -  0.7934D^n) 

r  o  | r  j  66  | r  |  '  20  30 ' 


u  r 


u  r 
o  o 


2  .  2 


+  N|r|6  T^f  (°10  -  °-6088D20  +  °-6088D30)  +  +  wq 

.  n  3ncrfw] 

+  Nrnuo(no  -  L)  +  -rr-J 
+  A<t>[(xGw  -  x^B)  cos  @o  cos  <j»Q] 

+  A9[-(x„w  -  x_B)  sin  9  sin  <p  +  (yrw  -  y  B)  cos  0  1 

Lr  D  O  O  o  D  O 


+  A6 


.l-Ni  |  rU  [r  j  +  N„u2  +  N.  u2 
1L  I  r|  6  o1  o1  6  o  5n  oj 

+  A5,  1.5868Ni  i„u  |r  [D_n  -  0.6088N,  i.u  |r  |  +  1.5868N„u2D 

2|_  | r I 6o  o1  o'  20  jr|6  o'  o'  66  o 

-  0.6088N*u2  +  1. 5868N . .  u2Don  -  0.6088N.  u2 

6  o  56n  o  20  6n  oj 

+  A6_  -1.5868N |  i-xu  lr  I  +0.6088N,  ._u  |r  j  -  1 . 5868N . -u2D^„ 

3|_  |  r  |  6  6  o'  o'  |  r  j  6  o'  o'  56  o  30 

2] 

u 

oj 


+  0.6088Ntu2  -  1.5868N,,  u2D,_  +  0.6088N*  . 

oo  66r)  o  30  on 
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APPENDIX  D 


SUMMARY  OF  NON -DIMENSIONAL I ZING  FACTORS  AND 
DIMENS IONALIZED  HYDRODYNAMIC  COEFFICIENTS 


NOTATION  [1] 


Symbol  Dimensionless  Form 


Def inition 


I 


x 


Moment  of  inertia  of  submarine  about 
x  axis 


I 

y 


Moment  of  inertia  of  submarine  about 
y  axis 


I 

z 


Moment  of  inertia  of  submarine  about 
z  axis 


I 

xy 


I' 

xy 


Product  of  inertia  about  xy  axis 


I 

yz 


I 

zx 


K 


* 


I' 

yz 


JLL. 


ZX 


zx 


ip*5 


K, 


k;  = 


1  3  2 

2  P*  U 


Product  of  inertia  about  yz  axes 


Product  of  inertia  about  zx  axes 


Rolling  moment  when  body  angle  (a,  6) 
control  surface  angles  are  zero 


and 


116 


NOTATION  (Cont.) 


Symbo 1 

Dimensionless  Form 

Definition 

K* 

*n 

K*n  = 

y  PC.V 

Coefficient  used  in  representing 
f  met  ion  of  (n-l) 

K*  as  a 

K’  = 

P 

K 

P 

First  order  coefficient  used  in 
ing  K  as  a  function  of  p 

represent- 

K. 

p 

y  PJJ4U 

K* 

P 

K* '  = 

P 

K- 
P  - 

1 

y  Pi 

Coefficient  used  in  representing 
function  of  p 

K  as  a 

K  |  , 

PIP! 

kpip! 

_  j’.Lp  ! 

}pi5 

Second  order  coefficient  used  in 
senting  K  as  a  function  of  p 

repre- 

K 

pq 

K’ 

pq 

K 

_es_ 

Coefficient  used  in  representing 
function  of  the  product  pq 

K  as  a 

K 

qr 

K’ 

qr 

A5 

Coefficient  used  in  representing 
function  of  the  product  qr 

K  as  a 

K 

r 

K'  = 
r 

K 

r 

First  order  coefficient  used  in 
ing  K  as  a  function  of  r 

represent- 

1  Ar 

y  pi  U 

K- 

r 

K-'  = 

r 

K- 

|pi5 

Coefficient  used  in  representing 
function  of  f 

K  as  a 

K 

V 

K'  = 

V 

K 

V 

First  order  coefficient  used  in 
ing  K  as  a  function  of  v 

represent- 

y  P«3U 

i 


) 
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NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Definition 


K- 


v 


K 


K'  I  , 

v  v 


K 


v  v 


Coefficient  used  in  representing  K  as  a 
function  of  v 


Second  order  coefficient  used  in  repre¬ 
senting  K  as  a  function  of  v 


K 


vq 


K' 

vq 


Coefficient  used  in  representing  K  as  a 
function  of  the  product  vq 


K 


vw 


K' 


vw 


K 

vw 


Coefficient  used  in  representing  K  as  a 
function  of  the  product  vw 


K 


wp 


K 

wp 


Coefficient  used  in  representing  K  as  a 
function  of  the  product  wp 


K 


wr 


K' 


wr 


K 


wr 


Coefficient  used  in  representing  K  as  a 
function  of  the  product  wr 


K5 


K6  “ 


5r 


1  3  2 

y  orr 


First  order  coefficient  used  in  represent¬ 
ing  K  as  a  function  of 


l  l' 


Overall  length  of  submarine 


m 


m 


Mass  of  submarine,  including  water  in 
free-flooding  spaces 


M . 


K 


1  3  2 

j  paV 


Pitching  moment  when  body  angles  (a,  6) 
and  control  surface  angles  are  zero 


118 


NOTATION  (Cont.) 
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NOTATION  (Cont.) 


Symbo 1 

Dimensionless  Form 

Definition 

M 

M*  = 
w 

M 

w 

First  order  coefficient  used  in  represent¬ 
ing  M  as  a  function  of  w 

n. 

w 

1  ,3„ 

2  Pi  U 

M 

wn 

Mf 

wn 

M 

wn 

j  o43U 

First  order  coefficient  used  in  represent¬ 
ing  M  as  a  function  of  (n  -  1) 
w 

M* 

w 

M*  1  = 

w 

M> 

w 

jp*4 

Coefficient  used  in  representing  M  as  a 
function  of  w 

Mi  | 

1  wl 

M,  . 

I  w  | 

}pe4 

First  order  coefficient  used  in  represent¬ 
ing  M  as  a  function  of  w;  equal  to  zero 
for  symmetrical  function 

Mi  | 

1  wl  *1 

Mf  , 

|  w|  q 

{p*4 

Coefficient  used  in  representing  M  as  a 
function  of  w  ^ 

M  |  | 
w|  w| 

M'  ,  , 
w  |  w  | 

M  |  t 

w|w| 

\  pi3 

Second  order  coefficient  used  in  repre¬ 
senting  M  as  a  function  of  w 

M  |  | 
w|  w|  n 

M1  |  | 

w|  w|  n 

II 

M'-L* 

First  order  coefficient  used  in  represent¬ 
ing  Mi  i  as  a  function  of  (n  -  1) 

°  w|Wj 

Mdb 

M6b  = 

M5b 

\  piV 

First  order  coefficient  used  in  represent¬ 
ing  M  as  a  function  of  5^ 

M<5 

M5  " 

M<s 

First  order  coefficient  used  in  represent¬ 
ing  M  as  a  function  of  6 

±p*V 

NOTATION  (Cont.) 
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NOTATION  (Cont.) 


Dimensionless  Form 


Def inition 


N’  , 

r  :  r 


N 

r 


r 


Second  order  coefficient  used  in  repre¬ 
senting  N  as  a  function  of  r 


N' 


r,  Jr 


r :  6  r 


Coefficient  used  in  representing  N .  as  a 
function  of  r  2r 


N' 

v 


~  oI3U 


First  order  coefficient  used  in  represent 
ing  N  as  a  function  of  v 


N ' 


vn 


N 

vp 


*  *1  — ’tt 

—  o  l  L 


First  order  coefficient  used  in  represent' 
ing  Nv  as  a  function  of  (r  -  l) 


Coefficient  used  in  representing  N  as  a 
function  of  v 


N 

_J2L 


Coefficient  used  in  representing  N  as  a 
function  of  the  product  vq 


v:  r 


L  ^ 

T  Ji 


Coefficient  used  in  representing  N  as  a 
function  of  v  r 


v 


Second  order  coefficient  used  in  repre¬ 
senting  N  as  a  function  of  v 


*'i  i 

v;  vjr) 


N  I  I 

vlvn 


First  order  coefficient  used  in  represent¬ 
ing  Nil  as  a  function  of  (n  -  1) 


NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Definition 


N 

vw 


N 

wp 


N 


wr 


N. 

or 


N 


5rn 


P 


q 


a 


N 

vw 


N  ' 
vw 

VW 

1  a3 

2  34 

Coefficient  used  in  representing  N  as  a 
function  of  the  product  vw 

N' 

wp 

N 

wp 

1  ,4 

2  °* 

Coefficient  used  in  representing  N  as  a 
function  of  the  product  wp 

N' 

wr 

N 

wr 

1  ,4 

2 

Coefficient  used  in  representing  N  as  a 
function  of  the  product  wr 

N '  = 

or 

N6r 

First  order  coefficient  used  in  represent¬ 
ing  N  as  a  function  of  o^ 

N' 

5rn 

N. 

■5rr 

1  , 3.  2 

2  C*.  U 

First  order  coefficient  used  in  represent¬ 
ing  N.  as  a  function  of  (n  -  1) 
or 

P'  = 

pi 

U 

Angular  velocity  component  about  x  axis 
relative  to  fluid  (roll) 

P'  = 

Pi2 

v2 

Angular  acceleration  component  about  x 
axis  relative  to  fluid 

q'  = 

SL i 

U 

Angular  velocity  component  about  y  axis 
relative  to  fluid  (pitch) 

q’  = 

ql2 

u2 

Angular  acceleration  component  about 
y  axis  relative  to  fluid 

r’  = 


r 


cl 

U 


Angular  velocity  component  about  z  axis 
relative  to  fluid  (yaw) 


NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Definition 


Angular  acceleration  component  about 
Z  axis  relative  to  fluid 


U 


U' 


U 

U 


Linear  velocity  of  origin  of  body  axes 
relative  to  fluid 


u 


Component  of  U  in  direction  of  the  x  axis 


ul 


Time  rate  of  change  of  u  in  direction  of 
the  x  axis 


u 


c 


Command  speed:  steady  value  of  ahead 
speed  component  u  for  a  given  propeller 
rpm  when  body  angles  (a,  1)  and  control 
surface  angles  are  zero.  Sign  changes 
with  propeller  reversal. 


Component  of  U  in  direction  of  the  y  axis 

Time  rate  of  change  of  v  in  direction  of 
the  y  axis 


w 


Component  of  U  in  direction  of  the  z  axis 


w 


Time  rate  of  change  of  w  in  direction  of 
the  z  axis 


x 


x 

i 


Longitudinal  body  axis;  also  the  coordi¬ 
nate  of  a  point  relative  to  the  origin  of 
body  axes 


*B 


The  x  coordinate  of  CB 
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NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Definition 


The  x  coordinate  of  CG 


qq 


x' 

qq 


_as_ 


1  ,4 


rP 


X' 

rP 


rr 


X' 

rr 


rr 


X-  f 
u 


j  pn3 


uu 


Xf 

uu 


uu 


Ip*2 


A  coordinate  of  the  displacement  of  CG 
relative  to  the  origin  of  a  set  of  fixed 
axes 


Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  q.  First  order 
coefficient  is  zero 


Coefficient  used  in  representing  X  as  a 
function  of  the  product  rp 


Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  r.  First  order 
coefficient  is  zero. 


Coefficient  used  in  representing  X  as  a 
function  of  u 


Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  u  in  the  non- 
propelled  case.  First  order  coefficient 
is  zero. 


X 


vr 


X' 


vr 


X 

vr 


Coefficient  used  in  representing  X  as  a 
function  of  the  product  vr 


X 


w 


X’ 


vv 


Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  v.  First  order 
coefficient  is  zero. 
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NOTATION  (Cont.) 


Symbo 1 

Dimensionless  Form 

Definition 

X 

wn 

X' 

wn 

X 

wn 

1  „  2 

2  pH 

First  order  coefficient  used  in  represent¬ 
ing  as  a  function  of  (n  -  1) 

X 

wq 

X' 

wq 

X 

wq 

1  „3 

2  PH 

Coefficient  used  in  representing  X  as  a 
function  of  the  product  wq 

X 

w 

X' 

ww 

X 

WW 

1  „2 
-T  pH 

Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  w.  First  order 

z 

coefficient  is  zero 

X 

wwn 

X' 

wwn 

X 

wwn 

1  ,2 
y  pH 

First  order  coefficient  used  in  represent¬ 
ing  X  as  a  function  of  (n  -  1) 

ww 

X5b6b 

x ' 

obSb 

X6b<5b 

1  9  9 

Second  order  coefficient  used  in  repre¬ 

i  P*V 

senting  X  as  a  function  of  6^.  First 

z 

order  coefficient  is  zero. 

X,  . 
<5r<5r 

X' 

6r6r 

X6r6r 

1  2  2 

4  PH  U 

Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  5  .  First 

z 

order  coefficient  is  zero. 

X*  X 

5r6rn 

Xl  X 

6r5rn 

X6r<5m 

1  2  2 

2  PH  U 

First  order  coefficient  used  in  represent¬ 
ing  Xgr5r  as  a  function  of  (n  -  1) 

Xx  x 
6s<5s 

XL 

5s6s 

X5s6s 

1  „2It2 
y  pH  U 

Second  order  coefficient  used  in  repre¬ 
senting  X  as  a  function  of  5  .  First 
order  coefficient  is  zero. 

X<5s5sn 

X5s<5sn 

X<5s6sn 

1  2  2 
j  PH  U 

First  order  coefficient  used  in  represent¬ 
ing  X.  .  as  a  function  of  (n  -  1) 
osos 

126 


NOTATION  (Cont.) 


Symbol  Dimensionless  Form  Definition 


y 

y’  « 

1 

i 

Lateral  body  axis;  also  the  coordinate  of 
a  point  relative  to  the  origin  of  body 

axes 

yB 

yB  = 

yB 

i 

The  y  coordinate  of  CB 

yc 

yG  = 

yG 

l 

The  y  coordinate  of  CG 

y0 

y0 

yo  = 

o 

i 

A  coordinate  of  the  displacement  of  CG 
relative  to  the  origin  of  a  set  of  fixed 

axes 

y* 

V  '  - 

Y 

Lateral  force  when  body  angles  (a,  3)  and 

1  ,  2rr2 

2  oil  U 

control  surface  angles  are  zero 

Y 

v 

Y  ' 

P 

First  order  coefficient  used  in  represent¬ 
ing  Y  as  a  function  of  p 

I 

p 

X 

P 

Y- 

Y- 

p 

Y*  '  = 

P 

.  „P. 

Coefficient  used  in  representing  Y  as  a 
function  of  p 

Ynlnl 

y  1  ! 
PIP! 

pipI 

=  £  LEI. 

j  Pi4 

Second  order  coefficient  used  in  repre¬ 
senting  Y  as  a  function  of  p 

Y 

Y 

pq 

Y* 

pq 

_ E3_ 

\  olk 

Coefficient  used  in  representing  Y  as  a 
function  of  the  product  pq 
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NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Y'  =  _ 

qr  i  P*4 


Y’  =  - - — 

r  I  p*3u 


Y'  -  TT) 

rn  ' 


Y*  '  =  - - — 

r  1  ,4 

I  P 


Definition 


Coefficient  used  in  representing  Y  as  a 
function  of  the  product  qr 


First  order  coefficient  used  in  represent¬ 
ing  Y  as  a  function  of  r 


First  order  coefficient  used  in  represent¬ 
ing  Y  as  a  function  of  (r  -  1) 


Coefficient  used  in  representing  Y  as  a 
function  of  r 


y  Y'  H<5r 

Y  !  r  [  6r  Y  I  r  I  6r  1 


y1 — Lj-  Coefficient  used  in  representing  Y^  as  a 

j  pi  u  function  of  r 


Y  '  =  - - — 

v  |  p*2u 


Y'  .  Vn 

vn  y  pi2u 


Y*  '  =  - i— 

v  1  o3 

j  pi 


Y'  =  _ iiU 

|  P*3 


First  order  coefficient  used  in  represent¬ 
ing  Y  as  a  function  of  v 


First  order  coefficient  used  in  represent¬ 
ing  Y^  as  a  function  of  (n  -  1) 


Coefficient  used  in  representing  Y  as  a 
function  of  v 


Coefficient  used  in  representing  Y  as  a 
function  of  the  product  vq 
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NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Definition 


Y 


v  r 


Y'  . 
v 


Y  |  |  Y  *  . 

V  [  V  [  V  I  V 


j  pH3 


Y  , 
vl  v 


Coefficient  used  in  representing  Y  as  a 
function  of  r 


Second  order  coefficient  used  in  repre¬ 
senting  Y  as  a  function  of  v 


Y  I  i  Y  ’  |  | 
v  |  v  |  n  v  |  v  |  p 


Y  I  I 
v  I  v  1  n 


First  order  coefficient  used  in  represent¬ 
ing  Y  |  i  as  a  function  of  (p  -  1) 

°  v  v  v 


Y 

vw 


Y' 

vw 


Y 

vw 


Coefficient  used  in  representing  Y  as  a 
function  of  the  product  vw 


Y 

y  y  I  _  _ W2_ 

wp  «P  Ip, 3 


Coefficient  used  in  representing  Y  as  a 
function  of  the  product  wp 


Y 

wr 


Y 

wr 


Y 

wr 


Coefficient  used  in  representing  Y  as  a 
function  of  the  product  wr 


Y 


fir 


Y' 

fir 


fir 


1  2  2 
j  Pi  U 


First  order  coefficient  used  in  represent¬ 
ing  Y  as  a  function  of  fir 


Y 


fim 


firn 


firn 


1  2  2 
j-  ph  u 


First  order  coefficient  used  in  presenting 

Y.  as  a  function  of  (p  -  1) 
or 


z 


Normal  body  axis;  also  the  coordinate  of  a 
point  relative  to  the  origin  of  body  axes 
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NOTATION  (Cont.) 


Symbol 

Dimensionless  Form 

Definition 

ZB 

ZB  = 

ZB 

l 

The  z  coordinate  of  CB 

ZG 

Zi  = 

ZG 

l 

The  z  coordinate  of  CG 

z 

0 

z'  = 

0 

z 

0 

Z 

A  coordinate  of  the  displacement  of  CG 
relative  to  the  origin  of  a  set  of  fixed 
axes 

z* 

z;  = 

z* 

Normal  force  when  body  angles  (a,  S)  and 
control  surface  angles  are  zero 

1  , 2,  ,2 

2  Pi  U 

2  i  | 

pip! 

Z’l  1 
p|p| 

=  ^eIe! 

j  pi4 

Second  order  coefficient  used  in  repre¬ 
senting  Z  as  a  function  of  p.  First  order 
coefficient  is  zero 

z 

q 

z'  = 
q 

z 

q 

First  order  coefficient  used  in  represent¬ 
ing  Z  as  a  function  of  q 

~  Pi3U 

z* 

q 

z> '  = 
q 

z- 

q 

Coefficient  used  in  representing  Z  as  a 
function  of  q 

^  |  q  |  6  s 

Z\  1  r 

|  q  |  os 

-  zki5s 

|  p*i3u 

Coefficient  used  in  representing  Z,.^  as  a 
function  of  q 

Z 

rP 

Z' 

rp 

ZrP 

~  pk 

Coefficient  used  in  representing  Z  as  a 
function  of  the  product  rp 
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NOTATION  (Cont.) 


Symbol  Dimensionless  Form 


Definition 


Z 

r 


r 


z' 


r  r 


Second  order  coefficient  used  in  repre¬ 
senting  Z  as  a  function  of  r.  First  order 
coefficient  is  zero 


Z 


w 


Z' 

w 


Z 

w 


j  PZ2U 


First  order  coefficient  used  in  represent¬ 
ing  Z  as  a  function  of  w 


Z 

qn 


Z' 

qn 


1  3 

J  Pi  U 


First  order  coefficient  used 
ing  Z^  as  a  function  of  (q  - 


in  represent- 

1) 


Z 


wq 


Z' 


wn 


z 

wn 


_L 

2 


pi2u 


First  order  coefficient  used 
ing  as  a  function  of  (n  - 


in  represent- 

1) 


Z- 

w 


Coefficient  used  in  representing  Z  as  a 
function  of  w 


Z 


wj 


pi2U 


First  order  coefficient  used  in  represent¬ 
ing  Z  as  a  function  of  w;  equal  to  zero 
for  symmetrical  function 


Z 


W  |  q } 


Z  I  I 
w  |  q  ! 


Coefficient  used  in  representing  Z  as  a 
function  of  q 


Z  I  |  Z  ’ , 
w| w|  w|w 


Second  order  coefficient  used  in  repre¬ 
senting  Z  as  a  function  of  w 


Z  |  |  Z’  |  | 
w|w|  n  w|  w|  n 


Z  |  , 
w|  wj  n 


First  order  coefficient  used  in  represent¬ 
ing  Z,|  as  a  function  of  (n  -  1) 
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NOTATION  (Cone.) 


Symbol  Dimensionless  Form 
Z 


ww 


Z' 

ww 


ww 


1  ,2 
y  pi 


Definition 


Second  order  coefficient  used  in  repre¬ 
senting  Z  as  a  function  of  w;  equal  to 
zero  for  symmetrical  function 


'5b 


7 1 

^5b 


'6b 


I  „  2..2 

—  pi  U 


First  order  coefficient  used  in  represent¬ 
ing  Z  as  a  function  of  6, 


'5s 


Z ' 
5s 


'6s 


1  2  2 
j  Pi  U 


First  order  coefficient  used  in  represent¬ 
ing  Z  as  a  function  of  5 


'Ssn 


z! 

5sn 


'5sn 


1  2  2 
j  PO 


First  order  coefficient  used  in  represent¬ 
ing  Z.  as  a  function  of  (n  -  1) 
os 


Deflection  of  bowplane  or  sailplane 
Deflection  of  rudder 
Deflection  of  sternplane 


n 


The  ratio  =  u' 


0 

<P 


a 


i’ 


Angle  of  pitch 
Angle  of  yaw 
Angle  of  roll 

Sets  of  constants  used  in  the  representa¬ 
tion  of  propeller  thrust  in  the  axial 
equation 
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') 

! 

L _ I 


Axial  Coefficients 


XQQ 

XRR 

XRP 

-138568. 

-11547. 

54588. 

XVR 

XWQ 

XUU 

63161. 

-58728. 

0 

xww 

XDD 

XWN 

120.204 

-188.02 

0 

XDDN 

XDBDB 

0 

-91.044 

Lateral  Coefficients 

YRDOT 

YPDOT 

YPABP 

-39890. 

-72433. 

0 

YVDOT 

YVQ 

YWP 

-79122. 

0 

58728. 

YR 

YP 

YABRD 

41705. 

-4549. 

0 

YSTAR 

YV 

YVABV 

0 

-1043. 

-2054.2 

YD 

YRN 

YVN 

185.036 

0 

0 

YDN 

YPQ 

43.371 

138568. 

XUDOT 

1819.584 

XVV 

154.872 

XWWN 

0 


YQR 

0 

YWR 

0 

YVABR 

0 

YVW 

0 

YVABVN 

0 
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Normal  Coeff ic lent s 


ZQDOT 

-170000. 

ZPABP 

0 

ZRABR 

0 

ZRP 

0 

ZWDOT 

-69459. 

ZVR 

0 

ZVP 

-33067. 

ZQ 

-42148. 

ZABQDD 

0 

ZWABQ 

0 

ZSTAR 

0 

ZW 

-1044.3 

ZWABW 

0 

ZABW 

-8.97 

ZVABV 

0 

ZD 

248.054 

ZQN 

0 

ZWN 

0 

ZWABWN 

0 

ZDN 

31.34 

ZDB 

-175.90 

ZABQD 

0 

zww 

15.99 

Rollins  Coefficients 

KPDOT 

1133000. 

KRDOT 

-906993. 

KQR 

-2796560 

KPQ 

0 

KPABP 

0 

KP 

-153265. 

KR 

-398900. 

KVDOT 

-15746 

KVQ 

0 

KWP 

53283. 

KWR 

0 

KSTAR 

0 

KV 

-3423. 

KVABV 

0 

KVW 

0 

KD 

1568. 

KSTARN 

0 

K4S 

1281.4 

K8S 

0 
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Pitching  Coefficients 


MQDOT 

MPABP 

MRABR 

-124300000. 

0 

0 

MQABQ 

MWDOT 

MVR 

0 

-170600. 

0 

MQ 

MABQDD 

MABQD 

-4066000. 

0 

0 

MSTAR 

MW 

MWABW 

0 

221.62 

-35873. 

MVABV 

MDD 

MD 

0 

0 

-23438, 

MWN 

MWABWN 

MDDN 

0 

0 

0 

MDB 

4222. 

Yawing  Coefficients 


NRDOT 

NPDOT 

NPQ 

-128800000. 

-434600. 

-97313000 

NRABR 

NVDOT 

NWR 

0 

-39800. 

0 

NVQ 

NP 

NR 

0 

-62986. 

-3766000. 

NABRD 

NABVR 

NS  TAR 

0 

0 

0 

NVABV 

NVW 

NDD 

49980. 

0 

0 

NRN 

NVN 

NVABVN 

0 

0 

0 

NDN 

-4374 

MRP 

29666000. 

MWW 

-1595.6 

MABWQ 

0 

MABW 

-239.72 

MQN 

0 

MDN 

-3058. 


NQR 

0 

NWP 

-138558. 

NABRDD 

0 

NV 

-12661. 

ND 

-9798. 

NDDN 

0 


CDCRSS 

.56889 
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APPENDIX  E 


DESCRIPTION  OF  PROPULSION  MODELS  AND  NOMINAL  POINT  DETERMINATION 


There  are  two  propulsion  models  an  RPS  and  an  eta  propulsion 

model.  The  RPS  model  is  a  first  order  differential  equation  in  terms  of 

RPS  (revolutions  per  second)  and  is  considered  the  more  accurate  model 

of  the  two.  The  eta  propulsion  model  is  a  simplified  version  of  the  RPS 

model  in  that  it  is  a  first  order  differential  representation  where  eta 
u 

C 

(n)  is  defined  as  — .  U  is  the  actual  speed  of  the  submersible  and  u 
U  c 

is  the  commanded  forward  velocity.  The  eta  model  is  important  because 
it  was  the  model  that  was  linearized  and  included  in  the  linear  equa¬ 
tions  of  motion. 

In  order  to  find  a  nominal  point,  the  final  values  of  the  states 
(u,  v,  w,  p,  q,  r,  phi  and  theta)  from  the  RPS  integration  are  used  as 
an  initial  point  with  the  eta  model  integration.  The  nonlinear  equa¬ 
tions  are  again  integrated,  however,  using  the  eta  propulsion  model.  A 
search  routine  is  used  to  search  for  a  nominal  point  (a  local  equilib¬ 
rium  point  where  the  derivatives  of  the  state  variables  are  zero).  To 
get  some  idea  how  good  the  nominal  point  is,  the  accelerations  asso¬ 
ciated  with  each  of  the  states  are  calculated.  As  a  rule  of  thumb, 

-6 

accelerations  should  be  less  than  10  .  The  equilibrium  point  for  this 

model  is  listed  below. 
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XDOT  (1)  =  -0. 134572E-10 

XDOT  (2)  =  -0.132110E-07 

XDOT  (3)  =  -0. 130859E-08 

XDOT  (4)  =  -0 . 297533E-08 

XDOT  (5)  =  0 . 137816E-10 

XDOT  (6)  =  0. 999896E-10 

XDOT  (7)  =  -0 . 568434E- 1 3 

XDOT  (8)  =  0. 145519E-10 


u  =  0.351355E+02 

v  =  0. 31 7284E+00 

w  =  -0.678508E-02 

P  =  0 . 368353E-06 

q  =  -0.9961 5 9E-04 

r  =  -0 . 368482E-02 

phi  =  0 . 154836E+01 

theta  =  0 . 572548E-02 

psi  =  -0.21114 IE+02 

z  =  -0. 170338E+00 

DB  =  0 

D1  =  2.0 

D2  =  0.5 

D3  =  -0.4744 


APPENDIX  F 


MODAL  ANALYSIS  MATRICES 


OBSERVABILITY (T*C) 


7.15B3E-03  4.8423E-03 
O.OOOOE+OO  O.OOOOE+OO 


-2.1290E-03 

O.OOOOE+OO 

2.4489E-03 

0.0000E+00 

-7.8333E-01 

O.OOOOE+OO 


■2.0743E-03 

O.OOOOE+OO 

1.4809E-03 

O.OOOOE+OO 


-1. 9729E-02 
O.OOOOE+OO 

1.3494E-02 

O.OOOOE+OO 


5. 2430E-03 
O.OOOOE+OO 

2.41I1E-03 

O.OOOOE+OO 

3.3434E-02 

O.OOOOE+OO 


3.2220E-03 

4.9118E-03 

-5.455BE-01 

7.0275E-02 

1.4737E-03 
3. 1373E-04 


3.2220E-03 
-6. 91 10E-O3 

-5.4538E-0I 

-7.0273E-02 

1.4757E-03 
-3. 1373E-04 


1. J742E-03 
O.OOOOE+OO 

-6. 4347E-03 
O.OOOOE+OO 

4.7821E-02 

O.OOOOE+OO 


-2.7719E-02 

O.OOOOE+OO 

2.4790E-0I 

O.OOOOE+OO 

4.3741E-03 

O.OOOOE+OO 


CONTROLLABILITY 

-1.33IIE-02  2.3498E-01  2.I431E-01 
-8.0742E-11  7.1922E-11  -7.3943E-11 

4.2370E-01  -4.0879E-02  7.3270E-02 
1.1603E-10  -9.0817E-11  1.1742E-10 

•3.2482E+00  2.0472E+00  -1.7433E+00 
-3.4227E-09  2.9744E-09  -3.3771E-09 

1.0439E+00  -7.2340E-02  1.1274E+00 
I.1472E-10  1 . 1499E-10  -7.2479E-11 

3.0824E-01  -1.0009E-01  3.1397E-02 
9.4149E-01  -B.4784E-01  8.J702E-01 

3.0824E-01  -1.0009E-01  3.1397E-02 
-9.4I49E-01  8.4784E-01  -B.3702E-01 

-1.4724E-01  2.3913E+00  2.2443E+O0 
1.7908E-10  -1.7178E-10  1.4932E-10 


1.5352E+00  -4.7184E-01  4.8429E-01 
■4.4034E-09  3.4853E-09  -3.2003E-09 
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DIAGONAL  A  ftATRIHT'W) 

-2.0293E-02  -4.8182E-U  7.3209E-10  -4.3945E-10 
8.0822E-1S  3.1627E-13  9.9134E-13  2.3088E-14 

-9.9499E-09  -4.3774E-02  -3.8043E-09  9.8277E-10 
-3.7401E-14  -1.4489E-14  -2.0391E-12  -3.7494E-14 

-1.4483E-09  1.4344E-10  -1.B040E-01  3.4190E-10 
3.4934E-13  2.2144E-13  4.8431E-11  1.3S75E-I2 

-5.2042E-09  -3.3774E-10  4.4974E-09  -1.8432E-01 
-3.9472E-14  -4.8722E-14  2.9312E-13  9.8037E-14 

-1.3921E-09  -3.2740E-10  -1.0737E-09  1.4470E-11 
-7.2923E-10  -3.3548E-10  1.7830E-I0  1.4938E-10 

-1.3999E-09  -3.3429E-10  -1.0920E-09  3.4241E-U 
7.7433E-10  3.4244E-10  -1.9444E-10  -1.4378E-10 

-1.3947E-09  -4.2439E-10  1.4827E-09  -2.3007E-10 
4.4808E-14  -1.5415E-14  -2.1237E-12  4.2141E-I5 

-8.4933E-09  2.2834E-10  -B.5836E-09  9.8474E-I0 
-3.8494E-13  J.7923E-13  2.4495E-U  -I.U23E-12 


EI8ENVALUES 

-2.0293E-02  -4.3774E-02  -1.8040E-01  -1.8432E-01 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


-2.1739E-10  -2.9193E-10  -7.0223E-09  -4.9337E-09 
3.1149E-09  -3.1430E-09  9.1370E-13  -4.9420E-12 

•4.3444E-08  -4.5325E-0B  -3.1495E-09  1.1828E-07 
4.3310E-09  -4.3132E-09  -4.2S74E-12  1.2064E-U 

1.3579E-0B  1.0251E-08  -4.1731E-09  -1.833BE-09 
-3.4447E-09  4.3284E-09  7.3413E-U  -1.2183E-10 

1.4132E-0B  1 . 4424E-0B  1.0S43E-08  -3.3337E-0B 
7.0181E-08  -7.0459E-08  -1.3197E-U  -3.92B0E-U 

•3.0B31E-01  3.4939E-09  8.8439E-10  -1.1038E-09 
3.2247E-0I  -1.7384E-OB  1.883BE-09  1.0024E-08 

-8.2312E-09  -5.0851E-01  5.8881E-10  3.0Q42E-09 
2.4480E-08  -5.2247E-01  -1.9303E-09  -4.7210E-09 

•1.1268E-0B  -1 . 1079E— 08  -4.227BE-01  2.4002E-08 
“1.8744E-89  1 . 9342E-09  -4.4594E-13  2.1903E-11 

•8.2833E-09  -1.3044E-0B  4.4007E-09  -4.5B37E-01 
-4.8472E-10  1.1121E-09  1.1024E-11  -2.B917E-10 


-3.0831E-01  -3.0B31E-OI  -4.227BE-01  -4.3837E-01 
3.2247E-01  -5.2247E-01  O.OOOOE+OO  O.OOOOE+OO 
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EIGENVECTOR  (T) 


2. 13396-02 
0.00006*00 

1.4*406-02 

0.00006*00 

4. 1799E-01 
0.00006*00 

-2.94936-03 

O.OOOOE*00 

1.3937E-02 

0.00006*00 

-2.12906-05 

0.00006*00 

2.44896-03 

0.00006*00 

-7.85556-01 

0.00006*00 


-9.99946-01 

0.00006*00 

-8.52446-03 

0.00006*00 

-2.78146-03 

0.00006*00 

9.49916-03 

0.00006*00 

-4.40246-05 

0.00006*00 

7.15836-05 

0.00006*00 

-2.07436-03 

0.00006*00 

1.48096-03 

0.00006*00 


-5.32136-02 

0.00006*00 

-9.33746-01 

0.00006*00 

-3.53126-01 

0.00006*00 

3.40846-03 

0.00006*00 

-2.23156-03 

0.00006*00 

4.84236-03 

0.00006*00 

-1.97296-02 

0.00006*00 

1.34946-02 

0.00006+00 


9.05216-03 

0.00006*00 

-4.48596-03 

0.00006*00 

-9.99336-01 

0.00006*00 

-3.21076-04 

0.00006*00 

-4.17446-03 

0.00006+00 

5.24306-05 

0.00006+00 

2.41116-03 

0.00006*00 

3.34346-02 

0.00006+00 


2.88946-03 

-1.37876-03 

4.43946-01 

1.87406-01 

1.42316-01 

7.37386-03 

2.30896-01 

-3.31236-01 

1.25706-03 

3.38416-04 

3.22206-03 

4.91186-03 

-3.45586-01 

7.02736-02 

1.47376-03 

3.15736-04 


2.88946-03 

1.57876-03 

4.43946-01 

-1.87406-01 

1.42316-01 

-7.57386-03 

2.30896-01 

3.31236-01 

1.25706-03 

-5.38416-04 

3.22206-03 

-4.91186-03 

-5.45386-01 

-7.02756-02 

1.47576-03 

-3.13736-04 


4.39306-02 

0.00006*00 

3.92256-02 

0.00006*00 

9.95036-01 

0.00006*00 

4.25736-03 

0.00006+00 

-4.21926-02 

0.00006*00 

1.37426-03 

0.00006*00 

-4.43476-03 

0.00006*00 

4.78216-02 

0.00006+00 


2.27006-02 

0.00006*00 

-9.44476-01 

0.00006*00 

4.28176-04 

0.00006*00 

-1.74346-01 

0.00006*00 

-4.41816-03 

0.00006*00 

-2.77196-02 

0.00006+00 

2.47906-01 

0.00006*00 

4.37416-03 

0.00006*00 


APPENDIX  G 


L  MATRIX 


*tkix 

{  2i 

l 

2 

.  3 

1) 

0.0 

0.0 

0.0 

Z) 

0.0 

0.0 

0.0 

3) 

0.0 

0.0 

0.0 

41 

0.0 

0.0 

0.0 

5) 

0.0 

0.0 

0.0 

61 

1 . 000000000000E  too 

0.0 

0.0 

71 

0.0 

l.OOOOOOOOOOOOE+OO 

0.0 

ai 

0.0 

0.0 

l.OOOOOOOOOOOOE+OO 

91 

0.0 

0.0 

0.0 

10) 

0.0 

0.0 

0.0 

11) 

0.0 

0.0 

0.0 

12) 

-1 .8354Z0460000E  +01 

-1.403831751000E+00 

-Z.7Z3467750000E-0Z 

13) 

-1.19ZZ39Z58000E+01 

-1.310703360000E+00 

-7. 691884516000E-0Z 

14) 

1 . 1 748Z  7457000E +01 

1 . 333686037000E  +00 

-4.335761088000E-OZ 
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APPENDIX  H 


A,  B,  C,  G,  H,  (A-BG-HC)  Matrices 
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43703E-01  -.53404E-02  -.19627E-02  0.30208E-02  0.58597E»00  0.57055E+00  O.OOOOOE+QO  0.95681E-02  O.OOOOOE+OO  O.OOOOOE+OO 


0 . OOOOOOE  +00  0.000001 


C  Matrix 


41705*  01  -.51404*  0?  -.lHtTf-Ot  0.3O2O0C-O2  0,585571*00  -.25507**01  -.33545**00 


.57500* *00  0.35207*  01  -,15574F*01 


